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ABSTRACT 


CONTROL  SYSTEM  DESIGN  FOR  AN  UNMANNED,  UNTETHERED 
UNDERWATER  VEHICLE 

by 

JAMES  HENRY  GILLARD 

Submitted  to  the  Department  of  Ocean  Engineering 
on  May  7,  1982  in  partial  fulfillment  of  the 

requirements  for  the  Degree  of  Ocean  Engineer 
and  the  Degree  of  Master  of  Science  in  Naval 
Architecture  and  Marine  Engineering. 

ABSTRACT 


A  procedure  for  the  control  system  design  for  a  small 
unmanned,  untethered,  underwater  vehicle  was  specified.  The 
early  phases  of  this  design  procedure  were  performed  for  the 
vehicle.  The  linear  equations  of  motion  for  small 
perturbations  about  an  equilibrium  condition  were  developed, 
and  the  values  of  the  hydrodynamic  coefficients  were 
determined.  After  the  transfer  functions  were  developed  to 
relate  the  vehicle  motion  in  each  of  the  six  degrees  of 
freedom  to  small  deflections  of  the  rudder  or  stern  planes, 
computer  programs  were  written  to  determine  the  poles  and 
zeros  of  the  transfer  functions.  The  vehicle's  response  in 
the  time  domain  to  one  degree  deflections  of  the  rudder  and 
stern  planes  was  determined  and  plotted.  The  vehicle's 
response  indicated  that  the  vehicle  was  stable  and  that  the 
size  of  the  control  surfaces  could  be  reduced  to  minimize 
drag  while  maintaining  vehicle  stability.  The  nonlinear 
equations  representing  the  vehicle's  motion  in  six  degrees 
of  freedom  were  incorporated  into  a  computer  model  of  the 
vehicle.  The  outputs  of  this  model  (  linear  and  angular 
velocities  in  six  degrees  of  freedom  )  are  the  state 
variables  which  will  be  needed  during  later  phases  of  the 
control  system  design.  modern  control  theory. 
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chapter  I 
INTRODUCTION 

The  potential  uses  for  a  small  unmanned,  untethered 
submersible  vehicle  (  SUUV)  are  numerous.  One  of  the  key 
systems  in  the  design  of  such  a  vehicle  is  the  control 
system,  which  must  be  able  to  control  the  vehicle: 

1.  during  transit  to  and  from  the  vehicle's  operating 
location  and  depth; 

2.  while  the  SUUV  performs  its  mission  on  location;  and 

3.  during  some  emergencies  for  which  pre-programmed 
corrective  action  has  been  specified. 

In  order  to  perform  these  functions,  the  SUUV's  control 
system  must  be  able  to  accept  pre-programmed  information 
concerning  course,  distance  and  operating  depths  as  well  as 
real  time  inputs  from  various  onboard  sensors.  The  output 
from  the  control  system  is  used  to  control  the  rudder  and 
horizontal  control  surfaces  and  ballast  control  system  to 
cause  the  SUUV  to  carry  out  its  programmed  assignments. 

The  length  of  the  mission  which  the  SUUV  will  be  able  to 
perform  will  be  dependent  on  the  amount  of  energy  which  can 
be  installed  and  the  rate  at  which  the  available  energy  is 
consumed.  Therefore,  the  control  system  should  be  optimized 
such  that  the  SUUV  expends  the  smallest  amount  of  ijnergy 
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while  it  perforins  its  mission.  Designing  the  control  system 
to  minimize  the  overall  vehicle  consumption  of  energy 
requires  that  different  solutions  to  the  control  system 
design  problem  be  evaluated  in  terms  of  energy  consumption. 
For  example,  the  size  of  the  vertical  and  horizontal  control 
surfaces  could  be  made  large  enough  to  provide  straight  line 
stability  of  the  vehicle  with  no  control  surface  deflection. 
Alternatively,  the  size  of  the  control  surfaces  could  be 
made  smaller  to  reduce  the  drag  and  thereby  reduce  the 
energy  required  for  propulsion.  However,  smaller  control 
surfaces  would  require  an  active  control  system  (an  energy 
drain)  to  provide  vehicle  straight  line  stability. 

The  design  of  the  control  system  should  follow  a  logical 
sequence.  Although  the  demarcations  between  different 
phases  of  the  design  process  are  not  distinct,  the  following 
phases  are  identified  for  this  project. 

Phase  I  Identify  the  vehicle  size,  shape  and  mission 
requirements . 

Phase  II  Identify  a  mathematicpl  model  to  represent 
the  motion  of  the  vehicle  in  six  degrees 
of  freedom.  Linearize  the  mathematical 
model . 

Phase  III  Calculate  the  values  of  the  hydrodynamic 
coefficients  in  the  linearized  equations. 
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Phase  IV  Form  the  transfer  functions  for  each  of  the 
linearized  equations.  Check  for  vehicle 
stability  by  calculating  the  values  of  the 
poles  and  zeros  for  each  transfer 

function.  Determine  the  vehicle  time 

response  to  a  small  control  surface 

deflection . 

Phase  V  Using  modern  control  theory,  model  the 
vehicle  in  state  space  using  the  six 

nonlinf ur  equations  which  describe  its 
motion.  Include  in  the  model  the  effects 
o*  random  environmental  disturbances. 

Phase  VI  Model  the  outputs  of  the  vehicle  sensors 

which  will  be  used  to  determine  the 

control  signal.  Include  the  effects  of 
random  noise  in  the  measurements. 

Phase  VII  Construct  an  observer  (Kalman  filter)  to 
estimate  values  of  the  states  which  cannot 
'  be  measured  directly  by  the  vehicle's 

sensors . 

Phase  VIII  Combine  Phases  V,  VI,  and  VII  into  a 
complete  model  of  the  vehicle's  motion. 
Use  this  model  to  design  a  linear  control 
system  which  will  control  the  vehicle  in 
the  predicted  manner. 
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In  this  thesis.  Phases  I  through  V  are  performed  in  detail, 
and  a  brief  discussion  of  Phases  VI,  VII  and  VIII  is 
provided . 

Phases  I  and  II  are  discussed  in  Chapter  Two.  Figure  1.1 
shows  the  principal  dimensions  of  the  SUUV.  Although  the 
shape  and  dimensions  were  selected  arbitrarily,  it  was  felt 
that  these  parameters  would  be  close  to  those  which  might  be 
selected  for  an  actual  vehicle  design.  The  control  system 
design  procedure  used  in  f’xs  thesis  should  be  appropriate 
for  any  vehicle  with  missions  similar  to  those  of  the  SUUV. 
Figure  1.2  is  a  block  diagram  representation  of  the 
anticipated  inputs  and  outputs  for  the  SUUV's  control 
system.  The  linearised  equations  which  are  developed  in 
Chapter  Two  are  adequate  to  predict  the  vehicle's  response 
to  small  perturbations  about  the  assumed  equilibrium 
condition  of  straight  ahead  motion  with  the  control  surfaces 
undeflected . 

Phase  III,  calculation  of  the  hydrodynamic  coefficients, 
is  performed  in  Chapter  Three. 

In  Chapter  Four,  the  linearized,  small  perturbation 
equations  of  motion  for  the  vehicle  which  were  developed  in 
Chapter  Two  are  solved  individually  to  find  the  transfer 
functions  (Phase  IV).  These  transfer  functions  relate  u 
(forward  velocity),  w  (vertical  velocity),  and  $  (pitch 
angle)  to  small  deflections  of  the  stern  planes;  and  v 
(sideslip  velocity),  (roll  angle),  and  0  (yaw  angle)  to 
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FIGURE  1.1  VEHICLE  SHAPE  AND  DIMENSIONS 


d 
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FIGURE  1.2  CONTROL  SYSTEM  INPUTS  AND  OUTPUTS 


The  poles  and  zeros  of 
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small  deflections  of  the  rudder, 
these  transfer  functions  uere  calculated.  Appendix  C 
contains  the  computer  programs  used  to  calculate  the  poles 
and  zeros  of  the  transfer  functions.  The  inverse  LaPlace 
transforms  of  the  transfer  functions  uere  evaluated  at  a 
series  of  times  to  determine  the  response  of  the  vehicle  to 
a  small  step  change  in  rudder  or  stern  plane  position. 
These  time  response  curves  uere  evaluated  to  determine  if 
the  settling  time  and  stability  of  each  response  mode  uere 
satisfactory.  The  computer  programs  used  to  calculate  the 
time  responses  are  listed  in  Appendix  D. 

Having  determined  from  the  classical  control  theory  that 
the  initial  estimate  of  the  geometry  of  the  vehicle  uas 
satisfactory  from  the  aspect  of  stability  and  time  response, 
in  Chapter  Five  modern  control  theory  uas  used  to  proceed 
uith  the  beginning  of  an  in-depth  design  of  the  control 
system  (Phase  V).  Figure  1.3  shous  a  block  diagram  of  the 
major  elements  of  a  modern  control  system.  This  thesis 
includes  a  development  of  the  model  used  to  represent  the 
motion  of  the  vehicle.  This  model  is  a  set  of  nonlinear 
equations  that  describe  the  complete  motion  of  the  vehicle 
in  six  degrees  of  freedom  -  surge.  suay.  heave.  roll, 
pitch.  and  yau  -  and  also  includes  terms  to  model  the 
effects  of  random  environmental  disturbances  on  the  vehicle. 
A  computer  program  is  described  uhich  uill  evaluate  the 
states  (velocities  and  angular  velocities)  at  a  given  time. 
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Disturbances 


FIGURE  1.3  BLOCK  DIAGRAM  OF  MODERN  CONTROL  SYSTEM 
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This  program  is  listed  in  Appendix  E.  Follou-on  work  to 
this  thesis  should  include  developing  computer  programs  to 
calculate  the  information  discussed  in  phases  VI  and  VII, 
and  then  using  the  program  in  Appendix  E  along  with  these 
neu  programs  to  model  the  complete  system  -  input,  plant, 
sensors,  observer,  disturbances,  and  output.  This  would 
allow  simulation  of  the  vehicle  motion  in  real  time  and  the 
vehicle  response  under  various  conditions  could  be 
evaluated.  Based  on  these  responses,  the  optimal  feedback 
gains  and  observer  gains  can  be  adjusted  if  necessary  to 
provide  the  required  vehicle  response. 

Chapter  Six  consists  of  a  short  summary  and  the 

conclusions  reached  by  the  author. 
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Chapter  IX 
EBUATIONS  OF  MOTION 


2 . 1  IDENTIFICATION  OF  THE  VEHICLE  AND  ITS  MISSION 

The  small  unmanned.  untethered.  underwater  vehicle  for 
which  this  control  system  design  procedure  was  developed  is 
depicted  in  Figure  1.1.  The  principal  dimensions  and 
characteristics  of  this  vehicle  are: 


Length  overall 
Maximum  diameter 
weight 
Buoyancy 

Control  surfaces 

Symmetry 


11.67  feet 
21  inches 
1162  pounds 
1162  pounds 
Rudder 

Stern  Planes 

Port-Starboard 

Deck-Keel 


The  mission  of  the  SUUV  is: 

1 .  Transit  to  operating  location  and  depth; 

2.  Operate  for  a  predetermined  period  performing  the 
intended  mission  such  as  monitoring  the  environment 
or  conducting  insp-^ctions  of  underwater  equipment; 
and 

3.  Return  to  the  predetermined  location  for  recovery. 
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2 . 2  DEVELOPMENT  OF  THE  EQUATIONS  OF  MOTION 

The  SUUV  uas  treated  as  a  rigid  body  uith  deck-keel  and 
port-starboard  symmetry  uhose  motion  can  be  described  using 
six  degrees  of  freedom  -  surge,  suay.  heave.  pitch.  roll, 
and  yau.  The  control  effectors  on  the  SUUV  include  a 
rudder,  horizontal  control  surfaces  called  stern  planes,  and 
a  propeller  at  the  stern.  Mathematical  equations  uhich  can 
be  used  to  model  the  movement  of  the  SUUV  in  all  six  degrees 
of  freedom  were  then  developed  follouing  the  procedure  used 
by  Humphreys''.  Appendix  A  contains  a  list  of  the  notations 
used  in  these  equations  and  throughout  this  thesis.  These 
notations  follou  the  standard  nomenclature  introduced  in  the 
Society  of  Naval  Architects  and  Marine  Engineers  TMB  1-5. * 
The  equations  which  describe  the  forces.  F,  and  moments. 
M.  acting  on  the  SUUV  ares 

__  .  _ _  (1) 

P  =  (Momentvun) 

OTV  *  TT  (Angular  momentum)  ( 2  ) 

dX 


^  Humphreys . D . E . ;  Development  of  the  Equations  of  Motion  and 
Transfer  Functions  for  Underwater  Vehicles  pp .  1-15  Naval 

Coastal  Systems  Laboratory;  Panama  City.  Florida.  July 
1976  . 

^  The  Society  of  Naval  Architects  and  Marine  Engineers.  TMB 
No.  1-5;  Nomenclature  for  Treating  the  Motions  q±  a 
Submerged  Body  Through  a  Fluid  ;  April.  1952. 
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A  set  of  right-hand,  orthogonal  coordinate  axes  centered  at 
the  center  of  mass,  CG,  of  the  SUUV  uas  used  to  develop  the 
equations  of  motion.  Positive  directions  for  the  axes, 
linear  velocity  components,  angular  velocity  components, 
angles,  forces  and  moments  are  shown  in  Figure  2.1. 

The  inertial  forces  and  moments  acting  on  the  vehicle  can 
be  written  as: 


2X  =  m(U  +  CM  -  RV) 


2Y  *  m(V  +  RU  -  PM) 


2Z  =  m(M  +PV  -  2U) 


•  # 

2K  =  PI  -  RI  +  2R(I  -  I  )  -  Pei 

X  X2  2  y  X2 


rn  =  21  +  PR(I  -  I  )  -  R*I  +  P*I 

y  X  2  X2  X2 


•  • 

2N  =  RI  -  PI  +  P2(I  -  I  )  +eRI 

2  X2  y  X  X2 


(3) 


(4) 


(5) 


(6) 


(7) 


(8) 


The  total  motion  of  the  vehicle  can  be  assumed  to  consist 
of  two  parts:  (i)  an  average  motion  representative  of  the 
equilibrium  condition;  and  (2)  a  dynamic  motion  that 
consists  of  small  perturbations  about  the  average  motion. 
Thus,  the  instantaneous  velocity  components  at  any  time  can 
be  written: 


FIGURE  2.1P0SIT1VE  DIRECTIONS  OF  AXES,  ANGLES,  VELOCITIES,  FORCES  AND  MOMENTS 
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(9) 


U  =  Uo  +  u 


V  =  Vo  +  V  (10) 

W  =  Wo  +  M  (11) 

P  =  Po  +  P  (12) 

Q  =  2o  +  q  (13) 

R  *  Ro  +  r  (14) 


The  zero  subscripts  represent  the  average  or  equilibrium 
velocity  components  and  the  small  letters  represent  the 
dynamic  velocity  components.  By  defining  the  equilibrium 
condition  as  straight  ahead  motion  with  control  surfaces 
undeflectedf  all  average  velocity  components  except  Uo  aze 
zero  and  the  total  velocity  equations  can  be  rewritten: 


U  *  Uo  +  u  (15) 

V  =  V  ( 16  ) 

M  =  w  (17) 

P  =  p  (18) 

2  =  q  (19) 

R  =  r  (20) 
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Substituting  these  equations  into  the  inertial  force  and 
moment  equations  yields: 


2X 


2Y 


ZZ 


2K 


2M 


2N 


m(u  +  qu  -rv) 


m(v  +  rUo  +  ru  -  pu) 


« 

m(M  +  pv  -qUo  -qu) 


•  • 

pi  -  rl  +  qr(I  -  I  )  -  pql 
X  xz  z  y  xz 


ql  +  pr(I  -  I  )  -  r^I  +  p^I 
y  X  z  xz  xz 


•  • 

rl  -  pi  +  pq(I  -  I  )  +  qrl 
z  xz  y  X  xz 


(21) 


(22) 


(23) 


(24) 


(25) 


(26) 


The  follouing  assumptions  will  allou  further  simplification 
of  these  equations. 

1 .  Assume  the  disturbances  from  the  equilibrium 
condition  are  small  enough  that  the  products  and 
squares  of  the  changes  in  velocity  are  small  compared 
to  the  changes  themselves. 

2.  Assume  the  disturbance  angles  are  small  enough  that 
the  sines  of  these  angles  may  be  set  equal  to  zero 


and  the  cosines  set  equal  to  one. 
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3.  Products  of  the  distuxbanc:::  angles  axe  approximately 
zero . 

The  following  equations  result  from  these  assumptions': 


• 

(27) 

SX  -  mu 

• 

(28) 

2Y  =  m(v  + 

rUo  ) 

• 

(29) 

2Z  =  m(w  - 

qUo  ) 

• 

« 

(30) 

2K  =  pi  - 

rl 

X 

xz 

• 

(31  ) 

2M  =  ql 

y 

• 

• 

(32) 

1 

H 

M 

II 

X 

pi 

Z 

xz 

Additionally,  using  the 

small  perturbation 

assumption  and 

equations  (15-20),  the 

relationship  between  the 

angular 

velocities  and  the  rate 

of  change  of  the 

angles 

can  be 

written : 

• 

(33) 

•e 

II 

p. 

• 

(  34) 

q  =  ^ 

• 

(35) 

r  = 

23 


In  addition  to  the  ineztial  forces  and  moments,  the  vehicle 
also  experiences  hydrodynamic  forces  and  moments  due  to  the 
forces  exerted  by  the  surrounding  fluid.  These  forces  and 
moments  are  functions  of  the  relative  velocity,  accele.  ation 
and  position  as  uell  as  control  surface  deflections.  They 
can  be  expressed  in  functional  form  as: 

•••••♦  (36) 

F  =  f  ( u ,  V  ,  u ,  u ,  V  ,  u ,  p ,  g ,  r  ,  p ,  q ,  r  ,  0 ,  ^  ,  ^ ,  £  ) 

These  forces  and  moments  can  be  expressed  in  terns  of  the 
Taylor  series  expansion  about  the  equilibrium  condition. 
Tuo  assumptions  allou  considerable  simplification  of  these 
expansions . 

1 .  Assume  second  order  and  higher  terms  may  be  neglected 
because  only  small  perturbations  from  the  equilibrium 
postion  are  allowed. 

2.  Assume  that  since  the  XZ  plane  is  a  plane  of 
symmetry,  X  ,  z  ,  and  n  are  functions  only  of 
u,u,q, their  derivatives,  and  S’,  and  Y  ,  H  ,  and  K 
are  functions  only  of  v,  p,  r,  their  derivatives  and 
0 . 

Therefore,  the  hydrodynamic  forces  and  moments  expanded  in  a 
Taylor  series  and  simplified  by  the  above  assumptions  can  be 
written  = 

Y.  -  Y  +  Y*v  Y  V  +  Y*p  +  Y  p  +  Y.^  +  Y  r  +  Y*r  +  Y.d^ 
hov  V  P  P  ^  r  r  6 

K.  -  K  +  K*v  +  K  V  +  K*p  +  K  p  +  K.*  +  Kir  +  K  r  +  K,6 
nov  V  P  P  9  r  r  6 

N.  -  N  +  N*v  +  N  V  +  N*p  +  N  p  +  N.^  +  Nir  +  Nr  +  N.6 
hov  V  P  P  9  r  ^  ° 


(37) 

(38) 

(39) 
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X.  -  X  +  X*u  +  X  u  +  X*w  +  X  w  +  x*q  +  X  q  +  X.0  +  X,6  (40;) 

n  o  u  u  w  w  q  9  o 

r  +  Z*u  +  Z  u  +  Z*w  +  z  w  +  Z*q  +  Z  q  +  Z-0  +  Z.6  (41) 

nou  u  w  w  q^q^0  5  ^ 

M.  »  M  +  M*u  +  M  u  +  M*w  +  M  w  +  M*q  +  M  q  +  M.0  +  M,6  (42) 

nou  u  w  w  q^q^0  o 

Terms  similar  to  X  <u>3u  expresses  the  change  in  the 
force  or  moment  because  of  the  disturbance  velocity.  X<u> 
is  called  a  stability  derivative  or  hydrodynamic  coefficient 
and  is  defined  as  the  change  in  the  X  force  uith  respect  to 
the  u  velocity  and  evaluated  at  the  equilibrium  condition. 

OX) 

X  =  _ 

u  ( 3u) 0 

The  gravity  and  buoyancy  forces  and  moments  can  be 
expanded  in  a  similar  fashion  and  the  complete  linearized, 
small  perturbation  equations  of  motion  for  the  SUUV  are- 

mi  -  X- i  +  XyU  +  X^i  +  X^w  +  X^4  +  X^q  +  Xg9  +  X^^d^  (43) 

m(w  -  U^0)  -  Z^u  +  Z^u  +  Z^w  +  Z^w  +  Z-q  +  Z^q  +  Zg0  +  Z^^S^  (44) 

ly®  “  “w''  **q^  ^^q'*  ”0®  C4  5) 

and 


3  The  notation  <  >  indicates  a  subscript. 
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m(v  +  uji)  -  Y^v  +  Y^v  +.  Y*p  +  Y^p  +  Y^(fr  +  Y^r  +  Y^r  +  Yj^6j^  (46) 

I  ({I  -  I  y  -  K*v  +  K  V  +  K*p  +  K  P  +  K  4.  +  K*r  +  K  r  +  K.  6  (47) 

x’'  xz  V  V  p*^  p  9  r  r  6^^^  k 

I  y  -  I  i  -  N*v  +  N  V  +  N-p  +  N  p  +  N.4>  +  N*r  +  N  r  +  N  5  (48) 

z  xz  V  V  P  P  9  r  r  6j^  K. 


These  tuo  groups  of  three  equations  (43-45)  and  (46-48) 
are  functions  of  different  variables.  Hence,  the  motion  of 
the  vehicle  can  be  examined  in  the  vertical  (XZ)  or 
horizontal  (XY)  plane  independently  of  motion  in  the  other 
plane.  (The  motion  of  the  vehicle  in  the  tuo  planes  is  said 
to  be  uncoupled.)  The  first  set  of  equations  is  usually 
called  the  vertical  or  longitudinal  set  of  equations  and  the 
second  set  is  often  called  the  horizontal  or  lateral  set  of 
equations . 
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Chapter  III 

CALCULATION  OF  THE  HYDRODYNAMIC  COEFFICIENTS 

3 . 1  CONTRIBUTIONS  FROM  THE  BODY 

The  values  for  the  hydrodynamic  coefficients  uere  calculated 
by  first  approximating  the  body  shape  as  an  ellipsoid  and 
calculating  values  for  this  shape >  and  then  calculating  and 


adding  the  contributions  from  the  fins  and  the 

ellipsoid  representing  the  body  is  depicted  in 

Volume  of  Ellipsoid 

V  =  4/3  TT  a  b* 

nozzle .  The 

Figure  3.1. 

r 

1 

1 

1 

V  =  18. 04  ft. 3 

i 

1 

1 

B  =  p  V 

1 

1 

1 

I 

1 

B  =  1162  Ibf. 

1 

1 

1 

Surface  Area  oi  Ellipsoid 


ab 

S  =  2Trb^  +  2ir  _ sin'^e 
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a  =  5.625* 
b  =  0.875* 

€  s  eccentricity 
€  =  c/a 

c  =  (a2  - 

€  =  0.988 


FIGURE  3.1  ELLIPSOID  USED  TO  REPRESENT  VEHICLE 
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€  =  C/a  where  e  =  eccentricity' 
e  =  .988 


I 


S 


49.3  ft.* 


I 


Landweber  and  Johnson^  determined  empirical  formulas  to 
determine  the  values  of  many  of  the  hydrodynamic 
coefficients.  These  formulas  contain  the  terms  K',K1,and  K2 
which  are  determined  for  this  vehicle  by  using  the  table 
provided  by  Lamb^ .  Entering  this  table  with  the  value  a/b  = 
5.714,  the  values  of  K*,  K1,  and  K2  are: 

K'  *  0.782 
K1  =  0.041 
K2  =  0.925 

noments  Inertia 

I  =  I  for  a  prolate  spheroid 
y  z 


'  Thomas,G.B.  Jr .  ;  Calculus  and  Analytic  ;  p.  478; 

Addison-Uesley  Publishing  Co.;  Reading,  Ma.;  1960. 

^  Landweber,  L.  and  Johnson , J . L . ;  Prediction  Dynamic 

Stability  Derivatives  ^  Elongated  Rgdl?  Sl.  1t^,v92u-ti.on  ; 
NSRDC  Report  C-359;  May, 1951. 

*  Lamb,  Sir  Horace;  Hydrodynamics .  6th  Ed.;  pp.  155;  Dover 
Publications , New  York,  1945. 
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I  =  m(a2  +  b*)/  5 

y 


I  =  234  slugs-ft.* 

y 


I 

I 


1 


I  =  234  slugs-ft.* 


L. 


J 


I  •  =  I  /(  1/2pl* ) 

y  y 


I  I  ’  =  I  ' 

I  y  a 

I 


I 


0.0013 


.j 


I  =  m(2b2)  /  5 

X 


I  1=11.1  slugs-ft.^  I 

lx.  I 

I  ■  I 

L _ I 


I  '  =  I  /( 1/2pl* ) 
X  X 


I  ’  =  .0000614 
X 

tl.a^s 

m  =  1162/32.2 

m  =  36.1  slugs 


m'  =  m/( 1/2pl^) 
m'  =  .02535 

Z  and  2 

G  6  G 

X  =  y  *  0 

G  G 

Z  =  -1/2inch  =  -.042ft, 
G 

3  '  =  -.0037 
G 
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Coefficient  cl£  Drag 

Neuman^  has  determined  that  for  three  dimensional  bodies 
uhere  the  maximum  thickness  is  less  than  one-fifth  of  the 
length.  the  frictional  drag  is  dominant  and  the  drag 
coefficient  can  be  predicted  from  the  flat-plate  drag 
coefficient  C<f>.  Assuming  a  speed  of  five  knots,  the  Reynolds 
number  is: 

Re  =  Ul/v 

Re  =  (SH  1 . 689)  (  10)  (  .  0929)/(  1 . 35  x  10**) 

Re  =  5.81  X  10*  (for  seauater  at  10®C) 

From  Figure  2.3  in  Newman® 

C  *  3.5  X  10-® 
f 

and  since  C  =  C 
D  f 

C  =  0.0035 
D 

dx 

X  =  - 

u  au 

X  =  -1/2pu2AC 

D 


’’  Neuman,  J.N.;  Marine  Hydrodynamics  ;  pp  20;  MIT  Press. 
Cambridge , Ma . :  1977. 


®  ibid 
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r' 


1 


I  Z  '  *  -.0142 

I  u 

I 


I 

I 

1 


I 

I 


I 

Y  ’  =  -.0142  I 

V  I 


L. 


pj 


l-l  and  Z-1 

V  V 


Y.'  =  Z.*  for  an  ellipsoid 

V  V 


Y. '  =  -Kjm' 

V 


r' 


I 


.j 


I  Z.'  =  -  .02345  I 

I  u  I 

I  I 
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n  and  JS 

U  V 

M  ’  =  0.87(K2  -  Ki jm’ 

u 


M  •  =  .0195 
u 


N  '  =  -.0195 

V 


Z  nnd  1 
q  r 

Z  ’  =  -(0,10  -  Ki)m’ 

q 


Z  ’  =  -.0015 

q 


Y  ’  = 


r 


.0015 
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n  H 

q  r 

M  '  =  -0.045  m* 

q 


I 

I  M  ’  =  00  1  14 

I  q 

I 


T 

I 

1 

I 


J 


I 

I 


I _ _ _ 


N  *  =  -.00114 
r 


■1 


1 

I 


H.  anl  M. 
q  E 


n. ’  =  -K’l  ’ 

q  y 


r 


T 


I 


M.  '  = 


q 


.00102  I 

I 

I 


I 


N. •  =  -  .00102 
r 


1 

I 
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JQ  aM  K 

9  <t> 


M  '  =  ra'g  Z  ' 
9  G 
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3.2  CONTRIBUTIONS  FROM  THE  FINS 

The  size  and  shape  of  the  fins  selected  uas  the  same  for  the 
xuddez  and  the  stern  planes.  Figure  3.2  sho.JS  the 
dimensions  and  shape  of  one  of  these  fins.  The  total  area 
of  both  the  port  and  starboard  stern  planes  uas  calculated 
to  be  0.4  square  feet. 


r 


I 


A 


0.4  ft. 2 


The  average  span  of  the  rudder  and  stern  planes  uas 
calculated  as  follous: 

S  =  ( ( .578  +  .375)  /  (2)  )2 
S  »  .972  ft. 

The  average  chord  uas  calculated  to  be: 

C  =  .365  ft. 

Aspect  Ratio 

AR  =  S/C 
AR  =  2.66 


Z  ’  =  -.5pUoA  C  /  (.5pUol2) 
u  f  La 


C  =  2t/(1+2/AR) 
La 
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AREA 

^  . 

.033 

ft 

AREA 

(::=•  . 

.045 

ft 

AREA 

□  = 

.122 

ft 

2 

2 

2 


Total  Area  (1  fin)  =  .2  ft,^ 
Total  Area  (2  fins)  =  ,4  ft.^ 


FIGURE  3.2  FIN  SIZE  AND  SHAPE 


39 


C  =  3.59 
La 

For  calculating  the  contributions  of  the  fins  to  the 
hydrodynamic  coefficients  N<v>,  M<m>,  N<r>,  N<v>,  y<r>, 
y<v>.  Z<w>!  Z<q>»  and  M<q>»  the  projected  area  of  the  nozzle 
also  uas  included  in  the  calculation  of  effective  fin  area 
and  span.  Figure  3.3  shous  the  effective  fin  used  in  these 
calculations . 


Z  '  =  -A  C  /  1* 
u  f  Lor 


Z  '  =  -  .040184 
u 


Z.’  =  -Stt  /  (  (  4j  S  2  +  C  z*)  1 3  ) 

u 


I  I 

I  Z. ’  =  -.000275  I 

I  u  I 

I  I 

I _ — _ _ _ _ _ I 


Z.  ’  =  (1  /  1)«(Z.  ’  ) 

q  X  U 


r 

I 

I 

I 

I 


Z. '  =  -.00014 

q 


I 

I 

I 

1 


*  =  z.  ’ 

u 


. '  =  -.000275 

V 


’  =  (1  /I) • (Z  ’ ) 

X  u 


I 

q 


2 


.0  146  1 
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Y  • 


r 


Z  ' 
1 


K  ’  =  (1  2/l)(Z  •) 

p  y  w 


K.  »  =  (1  2/1) (Z. »  ) 

p  y  « 


M  ’  =  (1  /1)(Z  ’) 

U  XU 


I  M  ’  =  -  .01311 

I  u 

I 


I 

I 

1 

I 


N  ’  =  M  ' 


V 


u 
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r 


1 

L. 


N  •  =  .001311 
V 


I 

I 

I 


.j 


M.  ’  =(1  /I) (Z  ’  ) 
U  X  u 


I 

I  M. '  =  -  .00014 

I  u 


1 


_ _ ; _ _ _ _ I 


=  M.  ' 


u 


I 

I 

I 


N.’  =  .00014 

V 


I 


M  ’  =  (1  2/l)(Z  ') 
q  X  U 


I 

I 

I 

I 


L _ _ 


M  ’  =  -.00775 

q 


■T 

I 


n. '  =  (1  2/1) (z. ’ ) 
q 


X 


u 


1 


-.0000017 


W. 

q 


N  ’  =  M  * 
r  q 


K  '  =  -.00775 
r 


N. ’  =  M. • 
r  q 


N. ’  =  -  .0000017 
z 


Y  *  C  A  / 
La  £ 


Y 

dR 


.  0074 
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1 

1 

1 

1 

z 

=  -.0074 

1 

1 

1 

1 

1 

1 

1 

1 

K 

6R 

=  0.0 

1 

1 

1 

1 

n 

=  -1  C  k  /  (1^) 

5S 

X  La  ± 

r 

1 

1 

1 

M 

=  -  .0037 

1 

1 

1 

6S 

1 

1 

1 

1 

N 

=  M 

6JL 

dS 

1 

1 

1 

1 

N 

=  -  .0037 

1 

1 

1 

SR 

1 

1 

1 

L 

Table  3-1  lists  the  values  of  all  of  the  hydrodynamic 
coefficients  for  ease  of  reference. 
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TABLE  3-1  NONDIMENSIONAL  VALUES  OF  HYDRODYNAMIC  DERIVATIVES 


Hydrodyneunic 

Derivative 

BODY 

FINS 

TOTAL 

-0.00273 

-0.00273 

X. 

u 

-0.00104 

-0.00104 

Y 

V 

-0.01420 

-0.025980 

-0.04018 

Y- 

V 

-0.02345 

-0.000275 

-0.02373 

Y 

r 

0.00150 

0.01310 

0.0146 

Y- 

r 

0.0 

-0.000140 

-0.00014 

z 

w 

-0.01420 

-0.02598 

-0.04018 

Z* 

w 

-0.02345 

-0.000275 

-0.02373 

Z 

q 

-0.0015C 

-0.01310 

-0.01460 

z- 

q 

0.0 

-0.000140 

-0.00014 

<p 

-0.00302 

-0.00302 

K 

P 

o 

• 

o 

-0.0000445 

-0.0000445 

K. 

P 

o 

• 

o 

-0.0000017 

-0.0000017 

M 

0.01950 

-0.01311 

0.006395 

M- 

w 

o 

• 

o 

-0.000140 

-0.00014 

Table  3-1  (Con't) 


Hydrodynamic 

Derivative 

BODY 

FINS 

TOTAL 

^9 

-0.00302 

-0.00302 

M 

q 

-0.00114 

-0.006610 

-0.00775 

M- 

q 

-0.00102 

-0.0000017 

-0.00102 

N 

V 

-0.01950 

0.001311 

-0.01819 

N- 

V 

0.0 

0.000140 

0.000140 

N 

r 

-0.00114 

-0.006610 

-0.00775 

N* 

r 

-0.00102 

-0.0000017 

-0.00102 

0.007400 

0.00740 

^63 

-0.007400 

-0.00740 

0.0 

0.0 

‘^55 

-0.003700 

-0.00370 

-0.003700 


-0.00370 
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Chapter  XV 

DEVELOPMENT  OF  THE  TRANSFER  FUNCTIONS 


4.1 

The  linearized,  small  perturbation  equations  of  motion  uere 
developed  in  Chapter  Tuo .  After  substituting  equations  33. 
34,  and  35  into  the  equations  of  motion,  the  longitudinal 
and  lateral  equations  of  motion  can  be  written: 


LONGITUDINAL  EQUATIONS 

mi  -  X-i  -  X^u  -  X^w  -  X^w  -  X-0  -  X  e  -  x^e  -  Xj  dg  (49) 

mw  -  mU  0  -  Z*u  -  2  u  -  Z*w  -  Z  w  -  2*0  -  Z  0  -  Z„0  -  Z.  6  (50) 

o  uuwwq  q  0 

I  9  -  M*u  -  M  u  -  M*w  -  M  w  -  M*0’  -  M„0  -  M-0  6  (51) 

yuuwwqq0os  v"'*-/ 


M1£ML  E2UATI0NS 


mv  +  mU  \|»  -  Y*v  -  Y  V  -  Y*4  -  Y  4  -  Y.t  -  -  Y  ♦  -  Y.  6_ 

y  V  r  r  R 

I  -  I  Y  -  K-v  -  K  V  -  K-4  -  K  4  -  K.4  -  Kii?  -  K  i  -  K.  6- 
X  xz  V  V  p  p^  4  r  r  R 


I  f  -  I 


A  -  N*v  -  N  V  -  N*4  -  N  4  -  -  N*Y  -  N  ♦  -  N,  6_ 

c’  V  V  p^  r  r  R 


(52) 

(53) 

(54) 


The  terms  X<4s>4s,  Z<ds>4s,  M<4s>4s,  Y<4R>dR,  K<4R>4R, 
and  N<4R>4R  are  the  control  forces  and  moments  generated 


when  the  control  system  causes  small  deflections  of  the 


stern  planes  or  rudder. 
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The  transfer  functions  for  the 


response  of  the  vehicle  to  small  deflections  of  the  rudder 
or  stern  planes  are  developed  in  the  following  pages. 

4.2  LONGITUDINAL  TRANSFER  FUNCTIONS 

Taking  the  LaPlace  transform  of  the  longitudinal  equations 
yields  : 

((.  -  X-},  -  t-  X^s  -  X„lw  +  [-  X.,2  -  x^,  .  X,J8  .  Xj^5^  ,.55) 

1-  V  ■  *  !("•  -  +  I-  2:=^  -  (Z  +  BO^)s  -  ZjJ8  -  Z  «  (56) 

q  Og  s 

I-  M.s  -  Mju  +  h  M-s  -  M^Jw  +  (dy  -  M.)s2  -  M  s  -  Mg]0  -  5^  (57) 

s 


These  equations  were  nondimensionalised  by  dividing  the 
force  equations  by  1-'2  pl^Uo*»  the  moment  equations  by  1/2 
;7l^Uo*8  and  S  by  Ug/l  .  Then  the  nondimensionalised 
equations  can  be  written: 


NONDIHENSIONAL  LONGITUDINAL  ESUATIONS  QZ  MOTION 


f(m-  -  X'.)s'  -  X;]u'  -  [X'^s'  +  X;]w'  -  [X’.s'2  +  X's'  +  X’]9  .  X'  ^ 

S 


(58) 


-  z;iu'  +  I(m'  -  Z'.)s-  -  Zjw' 


-  [Z’*s'^  +  (Z'  +  m')s’  +  Z!]0  -  Z]  6 
q  q  o  0  s 

s 

.,2 


(59) 


I-  M’-s’  -  M^]u'  -  +  M^Jw*  +  I(r  -  M’-)s’^  -  M^s'  -  M']0  «  6^  (60) 
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The  transfer  functions  can  be  determined  for  a  given 
input  by  solving  the  transformed  simultaneous  equations  of 
motion  for  the  variable  of  interest  uith  all  other  inputs 
set  equal  to  zero.  For  example,  the  pitch  attitude  to  stern 
plane  deflection  angle  transfer  function,  using 
determinants,  can  be  uritten: 


QCa) 

«.(8) 


(m'  -  X'*)a'  -  X' 
u  u 


-  2'‘s'  -  Z' 
u  u 


-  M'*s'  -  M' 
u  u 


(m*  -  -  z; 

-  M's'  -  M' 
w  w 


(m'  ~  X';^)8'  -  x;  -X'^^s'  -  x; 
-  Z';^a'  -  z;  (m'  -  Z'^a' 


-  M'*s' 
u 


M 


M' 


w 


- 

(j.  .  .  m; 


These  determinants  were  expanded,  resulting  in  a  numerator 
polynomial  in  s'  over  a  denominator  polynomial  in  s ' .  The 
denominator  polynomial  for  the  three  longitudinal  transfer 
functions  is  a  common  polynomial.  Setting  this  denominator 
equal  to  zero  gives  the  characteristic  equation  whose  roots 
are  equal  to  the  poles  of  the  system.  The  damping  and  the 
natural  frequency  and  the  time  constant  of  the  system  can  be 
determined  from  this  characteristic  equation.  The 
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longitudinal  transfer  functions  can  be  summarized  as 
follows: 


0/6 


LONGITUDINAL  TRANSFER  FUNCTIONS 

.8 


n: 


s 


®e*'  + 


^Long  As'^  +  Bs'^  +  Cs'^  +  Ds'  +  E 


(61) 


N 


,W 


w'/6. 


A  s’^  +  B  s'^  +  C  s'  +  D 


V 


w 


^ong  As*^  +  Bs'^  +  Cs’^  +  Ds'  + 


E 


(62) 


u'/6 


A  s'^  +  B  s'^  +  C  s'  +  D 


u 


u 


®  ^Long  As'^  +  Bs'^  +  Cs'^  +  Ds'  +  E 


(63) 


The  coefficients  A>B>C>D>  and  E  and  the  coefficients  in  the 
numerators  are  evaluated  using  the  equations  in  Appendix  B. 
The  values  of  the  hydrodynamic  derivatives  used  to  evaluate 
these  coefficients  are  as  calculated  in  Chapter  Three.  In 
order  to  evaluate  the  transfer  functions >  a  computer  program 
was  written  which  first  determined  the  values  of  the 
coefficients  using  the  equations  in  Appendix  Br  and  then 
used  these  values  to  determine  the  roots  of  the  numerator 
and  denominator . 

Using  the  program  VERTLIN.FORT  (listed  in  Appendix  C)  the 
roots  of  the  polynomials  in  the  longitudinal  transfer 
functions  were  calculated  .  See  Table  4-1.  The  surge  (u) 
polynomial  coefficients  and  roots  are  zero  because  all  of 


52 


OUTPUT  VALUES  ARE  IN  DinENSIONAL  FORM 
COEFFS.  OF  CHARACTERISTIC  EQUATION 

A  B  C  D 

0.974719E-05  0.306286E-04  0.206294E-04  0.568815E-05 

ROOTS  OF  CHARACTERISTIC  EQUATION 

REAL  inAGINART 

-2.342500  0.0 


-0.361070  0.237651 


-0.361070 


-0.237651 


-0.077655  0.0 


PITCH  POLYNOMIAL  COEFFICIENTS 

ATHETA  BTHETA  CTHETA 

-0 .850454E-05  -0 . 754724E-05  -0 . 535090E-06 
ROOTS 

REAL  IMAGINARY 

-0.809735  0.0 


-0.077702  0.0 


VERTICAL  VELOCITY  COEFFICIENTS 

AU  BU  CM  DU 

-0 . 1 10338E-05  -0.463001E-0S  -0 . 1 1 3874E-05  -0 . 6 1 0 1 OOE-07 
ROOTS 

REAL  IMAGINARY 

-3.937668  0.0 


-0.180908  0.0 


-0.077621  0.0 


FORWARD  SPEED  POLYNOMIAL  COEFFICIENTS 


AU  BU 

0.0  0.0 

ROOTS 

REAL 

*»»*»*»***»****» 


CU 

0.0 

IMAGINARY 
0 . 0 


0.0 


0.0 


DU 
0 . 0 


0.331301 


TABLE  4-1  ROOTS  OF  VERTICAL  TRANSFER  FUNCTION 


MM 
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the  hydrodynamic  coefficients  associated  uith  X  were  assumed 
to  be  zero  except  X<u>  and  X<u>.  Figure  4.1,  uhich  is  a 
flou  chart  fox  VERTLIN.FORT  shous  the  method  used  to 
calculate  the  roots.  Subroutine  ZPOLR,  a  routine  written  by 
inSLflnc.  and  available  as  a  library  routine  at  C.S.  Draper 
Laboratory,  was  used  in  VERTLIN.FORT  to  find  the  zeros  of 
the  polynomials.  The  pitch  (^)and  heave  (u)  transfer 
functions  can  be  written  (after  cancellation): 

(S  +  .81 ) 

B/5s  =  - 

(S  +  2.34)(S  +  .36  +  .24j)(S  +  .36 


-  (64) 

-  .24j) 


w/5s 


(S  +  3.94)(S  +  . 18)  ^ 

-  (65) 

(S  +  2.34)(S  +  .36  +.24j)(S  +  .36  -  .24j) 


The  vehicle's  response  in  the  vertical  plane  was  then 
determined  by  finding  the  inverse  LaPlace  transform  for  ^(s) 
and  w(s)  assuming  a  one  degree  deflection  of  the  stern 
planes.  Pitch  angle  as  a  function  of  time  following  a  one 
degree  deflection  can  be  expressed: 

(?(t)  =  -0.027  -  0 . 0025(exp)  (-2 . 34t) 

+  0 . 03 (exp ) ( - . 36t ) ( cos . 24t  +  .66sin.24t)  (66) 

The  vehicle's  vertical  velocity  as  a  function  of  time 
following  a  one  degree  deflection  of  the  stern  planes  can  be 
expressed : 

w(t)  =  -.003  +  . 00 1 (exp) (-2 . 34t) 


+0 . 002 (exp ) ( - . 36t ) ( cos . 24t  +  .032sin.24t) 


(67) 


Sf€cifY  «»«.».  AfM  cM-culAtc  Pitch  He^-ve  Rcors  mJ 

y^RtA>l■C5  iwtcfrcrJ  co«<^tcten«i  _  writ*  »oo«>  m  oiwfiw  wtr^scT 


FIGURE  4.1  FLOWCHART  FOR  VERTLIN.FORT 
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Plots  of  9(t)  and  u(t)  are  shoun  in  Figure  4.2  and  4.3  These 
plots  shou  that  the  vehicle  behaves  in  a  stable,  predictable 
manner  in  the  vertical  plane  follouing  a  small  stern  plane 
deflection . 


In  the  expressions  for  pitch  angle  and  vertical  velocity  as 
functions  of  time,  it  can  be  seen  that  some  terms  are  much 
smaller  than  others.  This  indicates  that  the  effects  of 
some  poles  and  zeros  are  insignificant  in  comparison  to  the 
effects  from  the  remaining  poles  and  zeros.  When  these 
zeros  and  poles  uhich  have  only  minor  effects  are  dropped 
from  the  transfer  functions,  the  transfer  functions  can  be 
written : 


(S  +  ,81) 

<?(s)  =  -  (68) 

(S  +  .36  +  .24j)(S  +  .36  -  .24j) 


(S  +  .18) 

u(s)  =  -  (69) 

(S  +  .36  +.24j)(S  +  .36  -  .24j) 


The  system  characteristic  equation  can  now  be  written: 
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PITCH  MOTION 

5/6/1982 


FIGURE  4.2  PITCH  MOTION  FOR  A  ONE  DEGREE  STERN  PLANE 
DEFLECTION 
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Z  VELOC.  (FT. PER  SEC.) 

5/6/ 1982 


FIGURE  4.3  HEAVE  MOTION  FOLLOWING  A  ONE  DEGREE  STERN  PLANE 


DEFLECTION 
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S*  +  .76S  +. 187  =  0  (70) 

This  equation  is  of  the  £ozm> 

S*  +  2?yn  +  =  0 

where  f  s  damping  ratio 

un  =  natural  frequency 

Solving  for  the  damping  ratio >  natural  frequency  and  system 
time  constant: 


r  =  0.88 

un  =  0.432 

T  =  14.5  secs. 


4.3  LATERAL  TRANSFER 


The  transfer  functions  for  the  lateral  equations  were 
determined  and  analyzed  using  the  same  procedure  just 
completed  for  the  longitudinal  equations.  Equations  (52-54) 
were  nondimensionalized  in  the  same  fashion  as  were  the 
longitudinal  equations.  with  the  additional  definition  that 


v/Uo 
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Nondimensionaliaed  Lateral  ggya-tAgns  Sl. 


[(m’  -  Y'^)s'  -  y;]B  +  t-  Y'-s’^  -  Y*s*  -  Yj].fr 

+  [-  Y’^s'^  +  (m’  -  Yps'l'fr  - 

f-  K’;»’  -  k;is  +  i(i;  -  -  k;u 

♦  f<-  r,  -  -  rs’I*  - 

t-  .  H.  JS  +  ((-  I'^  -  h'j)s'2  -  rs-  -  NJI* 

+  t(Ij  -  »’ps'^  -  rsMt  - 

R 


(71) 


(72) 


(73) 


The  lateral  transfer  functions  uere  determined  from  these 
equations . 

lateral  Transfer  Functions 


s/5  "‘r  »'(V'*V'*V'-^V 

^  ^at  8'(As'^  +  Bs'^  +  Cs'^  +  Ds'  +  E) 


(74) 


< 


R 


(A*8’^  +  B^8’  +  CJ 


^at  s'CAa'^  +  Ba'^  +  Ca'^  +  Da'  +  E) 


(75) 


“  r 


A.a'^  +  B^a’^  +  C.a'  +  D, 

. _ »  » _ 4 _ 4 _ 

Lat  8'(A8'^  +  Ba'^  +  Ca'^  +  Da’  +  E) 


(76) 
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Figure  is  a  £lou  diagram  of  the  computer  program 


HORLIN.FORT  (listed  in  Appendix  C).  The  values  of  the 
coefficients  and  roots  for  the  lateral  transfer  functions 
were  calculated  uith  HORLIN.FORT  and  are  listed  in  Table 
4-2.  The  coefficients  and  the  roots  of  the  roll  polynomial 
are  equal  to  zero  because  of  the  vehicle's  symmetry  in  both 
the  vertical  and  horizontal  planes.  The  transfer  functions 
for  the  suay  and  yau  motion  are  written  (after 
cancellation) : 


v(s)/3r(s) 


(S  +  4.38) 

(S  +2.69) (S  +  .45) 


(77) 


\^( s  )/5r  ( s  ) 


(S  +  .81) 


(S  +  2.69)(S  +  .45) 


(78) 


v(t)  and  ^(t)  were  determined: 

v(t)  =  0  58  -  0.62exp(-.45t)  (79) 

\^(t)  =  .014  -  O.OIt  -  0.012exp(-.45t)  (80) 

Plots  of  v(t)  and  v^(t)  are  shown  in  Figures  4.5  and  4.6. 
These  plots  show  that  the  vehicle  is  stable  and  behaves  in  a 
predictable  manner  in  the  horizontal  plane  for  small 
deflections  of  the  rudder. 

In  order  to  maximize  the  use  of  the  installed  energy,  the 
control  surfaces  should  be  redesigned  to  reduce  their  area, 
which  would  reduce  the  drag  on  the  vehicle  and  thereby 
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FIGURE  4.4  FLOWCHART  FOR  HORLIN.FORT 
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OUTPUT  VALUES  ARE  IM  OIMEKSIOKAL  FORM 
COEFFS.  OF  CHARACTERISTIC  EQUATIOH 

A  B  C  0  E 

0.301377E-07  0.110544E-06  0.899080E-06  0.257019E-05  0.976523E-06 

ROOTS  OF  CHARACTERISTIC  EQUATION 

REAL  INAGIKARY 

-0.264699  5.186463 


-0.264699  -5.186463 


-2.692328  0.0 


-0.446244  0.0 


SIDESLIP  POLTNOniAL  COEFFS. 

ABETA  BBETA  CBETA  DBETA 

0.279417E-07  0.137099E-06  0.818321E-06  0.329856E-05 

ROOTS 

REAL  INAGINARY 

-4.377226  0.0 


-0.264695  -5.186463 


-0.264695  5.186463 


ROLL  POLYNOniAL  COEFFS. 

APHI  BPHI  CPHI 

0.0  0.0  0.0 

ROOTS 

REAL  INAGINARY 

0,0 


xxxxxxxxxxsxxxxx  0.0 


YAM  POLYNOMIAL  COEFFS. 

APSI  BPSI  CPSI  DPSI 

-0 . 269345E-07  -0 . 362082E-07  -0 . 738029E-06  -0 . 59 1 960E-06 
ROOTS 

REAL  IMAGINARY 

-0.264697  5.186465 


-0.264697  -5.186465 


-0.814914  0.0 


TABLE  4-2  ROOTS  OF  HORIZONTAL  TRANSFER  FUNCTIONS 


FIGURE  4.6  YAW  MOTION  FOR  A  ONE  DEGREE  RUDDER  DEFLECTION 
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maximize  mission  range  oz  time.  After  selecting  a  neu  fin 
size  and  shape*  the  affected  calculations  in  Chapter  III 
should  be  repeated  to  determine  neu  hydrodynamic 
coefficients .  Then  the  analysis  of  this  chapter  should  be 
repeated.  Thj.s  sequence  should  be  repeated  until  the  size 
of  the  control  surfaces  is  the  smallest  uhich  uill  provide 
the  desired  control  characteristics. 
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Chapter  V 

APPLICATION  OF  MODERN  CONTROL  THEORY 

After  analyzing  the  vehicle  using  classical  control  theory, 
the  next  step  uas  to  apply  the  principals  of  modern  control 
theory  which  uses  state  space;  state  variables  and  state 
vectors  to  describe  the  dynamic  system  which  is  to  be 
controlled.  Modern  control  theory  can  be  used  to  design 
control  systems  which  have  multiple  inputs  and  multiple 
outputs . 

The  state  variables  are  a  set  of  variables  of  interest, 
X<i>,  which  completely  describe  the  state  of  the  system  at 
any  fixed  time.  The  finite  number,  n,  of  state  variables 
which  can  completely  describe  the  system  at  any  instant  form 
an  n  component  state  vector: 

it  =  (Xi  ,Xz  ,  .  .X<n>) 

The  inputs  to  the  system  are  represented  by  a  control 
vector,  U. 

The  state  equations  which  represent  the  system  are  then 
written  in  the  form: 

X  =  A  X  +  1  U 

•:*  _  -  -- 

Y  =  C  X  +  D  U 
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where  A,B,C>  and  D  are  coefficient  matrices  and  Y(t)  is  the 
output  vector.  The  state  variables  are  not  a  unique  set. 
That  is r  various  sets  of  state  variables  can  be  used.  Uhere 
possible,  it  is  advantageous  to  choose  as  the  state 
variables  those  variables  which  have  physical  significance 
and  which  can  be  measured. 

The  next  step  in  the  design  sequence  was  to  model  the 
nonlinear  motion  of  the  vehicle  in  six  degrees  of  freedom. 
Appendix  D  contains  a  listing  of  the  six  nonlinear  equations 
which  were  proposed  as  the  standard  equations  of  motion  for 

submarine  simulation^ . 

1  0 

Appendix  E  contains  the  listing  of  a  computer  subroutine 
which  uses  these  equations  to  calculate  the  values  of  the 
vehicle’s  linear  and  angular  velocities  in  both  the  body 
coordinate  system  and  the  earth  coordinate  system.  The  flow 
chart  for  this  subroutine  is  shown  in  Figure  5.1. 

This  completes  Phases  I  through  V  of  the  control  system 
design  process  as  discussed  in  Chapter  I.  Additional  work 
on  this  topic  should  begin  with  Phase  VI  and  precede  to  the 
final  control  system  design. 
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Gerter ,  M.  and  Hagen,  G.R.;  Standard 
for  Submarine  Simulation;  NSRDC 
Washington  D.C.  ;  June,  1967 


Equations  of  Motion 
Report  No.  2510; 


1 0 


Lee,  Jang  Gyu;  The  Charles  Stark  Draper  Laboratory,  Inc.;  February,  1982 


ESThftUSW  6woCK5  I  I  cKwcolAtC  V<An<Au  FoAcE*  PM(I>) 


FIGURE  5.1  FLOWCHART  FOR  SUBROUTINE  TRUMOD 
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Chapter  VI 
COKCLUSIONS 

A  general  procedure  for  the  control  system  design  of  a  small 
unmanned,  untethered,  underwater  vehicle  uas  formulated. 
The  early  phases  of  the  procedure  were  accomplished  for  the 
vehicle.  accomplished  for  a  vehicle. 

The  linearized  equations  of  motion  in  six  degrees  of 
freedom  for  small  perturbations  about  an  equilibrium 
condition  of  straight  ahead  motion  were  formulated,  and 
values  for  each  of  the  hydrodynamic  coefficients  in  these 
equations  were  calculated.  The  vehicle's  response  to  a 
small  control  surface  deflection  uas  analyzed  by  forming  the 
transfer  functions  for  each  of  the  equations  and  then 
solving  for  the  vehicle  response  in  the  time  domain.  The 
initial  design  of  the  control  surfaces  for  the  selected 
vehicle  size  and  shape  uas  conservative.  Smaller  control 
surfaces  should  be  designed  and  the  analysis  should  be 
repeated  until  the  smallest  control  surfaces  which  provide 
satisfactory  vehicle  control  are  achieved. 

A  model  of  the  vehicle  was  formulate  using  the  nonlinear 
equations  of  motion.  Additional  work  in  the  area  of  this 
thesis  would  be  to  complete  a  nonlinear  model  of  the  vehicle 
and  its  control  system.  Modeling  of  the  vehicle's  sensors 
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and  measuzement  noise  tezms  and  constzucting  an  obsezvez  to 
calculate  non-obsezvable  states  aze  zequized  to  combine  uith 
the  nonlineaz  vehicle  model  and  input  tezms. 

This  complete  nonlineaz  model  should  then  be  used  to 
pzedict  the  vehicle's  zesponse  in  zeal  time.  An  actual 
contzol  system  should  then  be  designed  that  has  the  desized 
chazactezistics  to  contzol  the  vehicle  uithin  the  specified 
tolezances . 
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APPENDIX  A 


NOTATION 

Symbol  Oimensionloss  Form 


Definition 


6 

Buoyancy  force,  positive  upward 

CB 

Center  of  buoyancy  of  submarine 

CG 

Center  of  mass  of  submarine 

1  '  = 

X  ipi" 

Moment  of  inertia  of  submarine  about  x  axis 

V  '1^ 

Moment  of  inertia  of  submarine  about  y  axis 

T 

z 

I  '=  — ii- 
* 

Moment  of  inertia  of  submarine  about  z  axis 

w 

1  <  s  iiX. 

xy 

Product  of  inertia  about  xy  axis 

V 

I  '  = 

y*  |pt^ 

Product  of  inertia  about  ye  axes 

I  '=T^ 

*x 

Product  of  inertia  about  zx  axes 

K 

K>  -  ^ 

ipt®u* 

Hydrodynamic  moment  component  about  x 
axis  (rolling  moment ) 

K* 

ip4»U* 

Rolling  moment  when  body  angle  (eu  0)  and 
control  surface  angles  are  zero 

V'i^ 

Coefficient  used  in  representing  as  a 

function  of  (tj-I) 

X 

P 

K  '  =  ■  ^ 
p  ipt*u 

First  order  coefficiest  used  in  representing 

K  as  a  function  of  p 

K. 

P 

K.'  =  — ^- 
P  ip4« 

Coefficient  used  in  representing  K  as  a  function 
of  p 

%lpl 

*'pipr=j^ 

Second  order  coefficient  used  in  representing 

K  as  a  function  of  p 

K  *  =  — pq.. 
pq  tpt* 

Coefficient  used  in  representing  K  as  a  function 
of  the  product  pq 

r 
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K  ' 

qr 

ipt‘ 

Coefficient  used  in  representing  K  as  a 
function  of  tiie  product  qr 

V 

c 

u 

First  order  coefficient  used  in  representing 

K  as  a  function  of  r 

_  Kf 

Coefficient  used  in  representing  K  as  a 
function  of  f 

K 

V 

K  • 

=  Kv 

First  order  coefficient  used  in  representing 

K  as  a  function  of  v 

ipt^u 

K. 

V 

V 

ipt« 

Coefficient  used  in  representing  K  as  a 
function  of  v 

K  1  1 

v|v| 

Kv|, 

1  _  *^v|v| 

'1 

4 

Second  order  coefficient  used  in  representing 

K  as  a  function  of  v 

K 

vq 

V 

Coefficient  used  in  representing  K  as  a  function 
of  the  product  vq 

K 

vw 

K 

vw 

1  _  ^vw 
■ipt» 

Coefficient  used  in  representing  K  as  a  function 
of  t!ie  product  vw 

,  _  Kv,p 

4p-t^ 

Coefficient  used  in  representing  K  as  a  function 
*of  the  product  wp 

K 

wy 

Coaffietent  used  in  representing  K  as  a  function 
of  the  product  wr 

K. 

6r 

*'6r’ 

_  ^5r 

4pt^ 

First  order  coefficient  used  in  representing 

K  as  a  function  of 

1 

V  * 

1 

Overall  lengtit  of  submarine 

m 

m'  = 

m 

ipt’ 

Mass  of  submarine,  including  water  in  free- 
flooding  spaces 

M 

M'  = 

M 

Hyr’rodynamic  moment  component  about  y  axij 
(pit(.hing  moment) 

4p4»u* 

M,' 

M* 

*4;ftp 

Pitching  moment  when  body  angles  (or.  B)  and 
control  surface  angles  are  zero 

M 

PP 

M 

PP 

JpZ^ 

*-Wa_ 

iptvu 

Second  order  coefficient  used  in  representing 

M  as  a  function  of  p.  First  order  coefficient  is 
zero. 

M 

q 

M  ' 

q 

First  order  coefficient  used  in  representing 

M  as  a  function  of  q 

M 

qq 

qq 

First  order  coefficient  used  in  representing 
as  a  function  of  (rj-l) 

M. 

q 

M.' 

q 

- 

Jpt^ 

Coefficient  used  in  representing  M  as  a 
function  of  q 
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“qlq| 

“,1,1 

1^1  f,. 

|q|6s 

M 

rp 

^rp’ 

Mrp 

'ip^‘ 

M 

rr 

*^rr* 

ip-t* 

"*vp 

M  ' 
vp 

^vp 

ipf.^ 

M 

vr 

M  • 
vr 

.  Mvr 
ip-t-* 

M 

vv 

M  ' 
vv 

Mvv 

=  • 

M 

w 

M  '  ! 
w 

.  Mw 

* 

ip^  u 

‘  ipt* 

M|  , 

|w| 

M  , 

|w 

,  _  *^|w| 

1  ipt^u  . 

M,  , 

IHq 

M,  , 
lw| 

,  _  Iq 

q  ' 

I  W  I 

M  ,  , 

w|  w]t7 

M  ,  ,  '  Iw  I TJ 

M 

v/w 

M 

ww 

1  M-ww 
■  ipt"* 

^‘6b’ 

M(,b 

■  ipt-u* 

_  *^6s 

^6sr, 

,  MJstj 

Second  order  coefficient  used  in  representing 
M  as  a  function  of  q 

Coefficient  used  in  representing  as  a 
function  q 

Coefficient  used  in  representing  M  as  a 
function  of  the  product  rp 


Second  order  coefficient  used  in  representing 
M  as  a  function  of  r.  First  order  coefficient 
is  zero 

Coefficient  used  in  representing  M  as  a 
function  of  the  product  vp 


Coefficient  used  in  representing  M  as  a 
function  of  the  product  vr 


Second  order  coefficient  used  in  representing 
M  as  a  function  of  v 


First  order  coefficient  used  in  representing 
M  as  a  function  of  w 

First  order  coefficient  used  in  representing 
as  a  function  of 

Coefficient  used  in  representing  M  as  a  function 
of  w 

First  order  coefficient  used  in  representing  M 
as  a  function  of  w;  equal  to  zero  for  syminetrical 
function 

Coefficient  used  in  representing  Mq  as  a  function 
of  w  .  ’ 


Second  order  coefficient  used  in  representing  . 
M  as  a  function  of  w 


First  order  coefficient  used  in  representing 
I  **  *  function  of  (17- 1) 

Second  order  coefficient  used  in  representing 
M  as  a  function  of  w;  equal  to  zero  for  sym¬ 
metrical  function 

First  order  coefficient  used  in  representing 
M  as  a  function  of  6^ 

First  order  coefficient  used  in  representing 
M  as  a  function  of  6g 

First  order  coefficient  used  in  representing 
Mjs  as  a  function  of  (tj-1) 


7k 


u 

«  _  N 

*^*fp3PTJ* 

Hydrodynamic  moment  component  about  z 
aids  (yawing  moment) 

N* 

N* 

Yawing  moment  when  body  angles  (or.  $)  and 
control  surface  angles  are  aero 

N 

P 

Np 

^p  ipt^u 

First  order  coefficient  used  in  representing  N 
as  a  function  of  p 

N. 

P 

N*’  » 
p  4pt* 

Coefficient  used  in  representing  N  as  a  function 
of  p 

N 

pq 

N  '  a 

pq  ipi“ 

Coefficient  used  in  representing  N  as  a  function 
of  the  product  pq 

*^q*‘ 

Nqr 

N  '  a 
qr  ip4* 

Coefficient  used  in  representing  N  as  a  function 
of  the  product  qr 

N 

N  '»  r-g  ■ 
r  ipt^u 

First  order  coefficient  used  in  representing  N 
as  a  function  of  r 

N  •  «  JioL 
nj  Jpt*U 

First  order  coefficient  used  in  representing 

Nj.  as  a  function  of  (17- 1) 

N. 

r 

Coefficient  used  in  representing  N  as  a  function 
of  r 

”rlrl 

Second  order  coefficient  used  in  representing 

N  as  a  function  of  r 

N|rUr 

.  _  N|rl«r 
ipt*u 

Coefficient  used  in  representing  N,  as  a 
function  of  r 

N 

V 

N  '  =  ■ 

V  ipt^U 

First  order  coefficient  used  in  representing  N 
as  a  function  of-  v 

N 

V7> 

Nvti 

ipt*u 

First  order  coefficient  used  in  representing  Nv 
as  a  function  of  (tj-  1) 

N. 

V 

ip-t* 

Coefficient  used  in  representing  N  as  a 
function  of  v 

N 

vq 

N  •aJ!:a- 

vq  ipt4 

Coefficient  used  in  representing  N  as  a  function 
of  the  product  vq 

N,  , 

1  VI  r 

N,  ,  'a.^^ 

|v|r  ^44 

Coefficient  used  in  representing  Nj-  as  a 
function  of  v 

N  1  1 
vlvl 

N  ,  ,-  ai^ 

Secoi^  order  coefficient  used  in  representing 

N  as  a  function  of  v 

N  ,  , 

v|v|j7 

N  ,  ,  .  =5±:^ 

fo^- 

First  order  coefficient  used  in  representing 
*^v|vl  **  *  function  of  (7)->) 
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Nvw 

N  '  = 

ipt® 

Coefficient  used  in  representing  N  as  a  function 
of  the  product  vw 

N  •  =  5:^ 
wp 

Coefficient  used  in  representing  N  as  a  function 
of  the  product  wp 

N 

wr 

N  •  » 

4p-t^ 

Coefficient  used  in  representing  N  as  a  function 
of  the  product  wr 

6t 

N  '  -  , 

6r  ipt^U* 

First  order  coefficient. used  in  representing  N 
as  a  function  of  6^ 

N. 

bri) 

N  •  s 

^’■T)  ^p4^  U* 

First  order  coefficient  used  in  representing 
as  a  function  of  (tj-1)  - 

P 

Angular  velocity  component  about  axis 
relative  to  fluid  (roll) 

• 

P 

U* 

Annular  acceleration  component  about  x  axis 
relative  to  fluid 

q 

o'  =-aL 
^  u 

Angular  velocity  component  about  y  axis  relative 
to  fluid  (pitch) 

« 

q 

k'-K 

^  u* 

An^lar  acceleration  component  about  y  axis 
refiitive  to  fluid 

r 

_.  -  ri- 

T  --JJ 

Angular  velocity  component  about  x  axis 
relative  to  fluid  (yaw) 

• 

r 

±1  _  H* 

~1F 

Angular  acceleration  component  about  z  axis 
relative  to  fluid 

U 

u  -  =  iL  . 
u 

Linear  velocity  of  origin  of  body  axes  relative 
to  fluid 

u 

u'=^ 

Component  of  U  in  direction  of  the  x  axis 

u 

C» 

It 

=Js 

Time  rate  of  change  of  u  in  direction  of  the 

X  axis 

“c 

«c'»- 
'  U 

Command  speed:  steady  value  of  ahead  speed 
.  component  u  for  a  given  propeller  rpm  when 
body  angles  {a.  S)  and  control  surface  angles 
are  zero.  Sign  changes  with  propeller  reversal 

V 

V' 

U 

Component  of  U  in  direction  of  the  y  axis 

V 

V'  =ii- 

u* 

Time  rate  of  change  of  v  in  direction  of  the 
y  axis 
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w 

1 

W*  S  — 

U 

Component  of  U  in  direction  of  t]ie  z  axis 

• 

w 

u* 

Time  rate  of  change  of  vi  in  direction  of  the 
z  axis 

W 

w  -  ^ 

Weight;  including  water  in  free  flooding  spaces 

X 

X- 

1 

Longitudinal  body  axis;  also  the  coordinate  of  a 
point  relative  to  the  origin  of  body  axes 

’‘B 

Xp.'  =  -B- 

®  4 

The  X  coordinate  of  CB 

X  J  -  *G 

The  X  coordinate  of  CC 

>< 

o_ 

II 

A  coordinate  of  the  displacement  of  CC  relative 
to  the  origin  of  a  set  of  fixed  axes 

X 

_  X 
■  Jp4^U* 

Hydrodynamic  force  component  along  x  axis 
(longitudinal,  or  axial,  force) 

X 

qq 

X  '  = 

qq  ip^-* 

Second  order  coefficient  used  in  representing 

X  as  a  function  of  q.  First  order  coefficient 

is  zero 

X 

rp 

X  '  - 
rp  *  ip4« 

Coefficient  used  in  representing  X  as  a  function 
of  the  product  rp 

^rr 

X-- 

^rx 

Second  order  coefficient  used  in  representing 

X  as  a  function  of  r.  First  order  coefficient  is 

zero 

X. 

u 

X  '  - 
u  tp4- 

Coefficient  used  in  representing  X  as  a  function 
of  u 

X 

uu 

X  '  s  2Euu. 

““  ip4* 

Second  order  coefficient  used  in  representing 

X  as  a  function  of  u  in  the  non-propelled  case. 
First  order  coefficient  is  zero 

X 

vr 

Xvr 

V  t  - 

vr 

Coefficient  used  in  representing  X  as  a  function 
of  the  product  vr 

^vv 

X  ■  1  - 
vv  ■  Jp4* 

Second  order  coeffient  used  in  representing  X 
as  a  function  of  v.  First  order  coefficient  is  zero 

^vvr, 

^vvi7  ■ 

First  order  coefficient  used  in  representing  X^y 
as  u  function  of  (17- 1) 

Coefficient  used  in  representing  X  as  a  function 
of  the  product  wq 
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y 

X  • 
w\u  ip'C 

Second  order  coefficient  used  in  representing 

X  as  a  function  of  w.  First  order  coefficient  is 

zero 

^WV/7J 

y  1  - 

First  order  coefficient  used  in  representing  X^^ 
as  a  function  of  (t}-1) 

^6b6b 

V  ,  ^bhbh 

^bhbh  - 

Second  order  coefficient  used  in  representing  X 
as  a  function  of  6i,.  First  order  coefficient 
is  zero 

y 

-^6r6r 

^6r6rT} 

V  .  _  ^6r6r 

6r6r 

V  I  _  ^brbrt) 

6r6ri)  ^pi^U^ 

Second  order  coefficient  used  in  representing 

X  as  a  function  of  6^.  First  order  coefficient  is 
zero  •* 

First  order  coefficient  used  in  representing 
X^rjr  ^  function  of  (t)-!) 

^6s6s 

V  I  ^6s6s 

*^6865  ■  Jpi^U^ 

Second  order  coefficient  used  in  representing  X 
as  a  function  of  63.  First  order  coefficient  is 

zero 

X,  . 

5s6s7J 

V  ,  _  ^6s6st7 

6s6sri  ip^^U^ 

First  order  coefficient  used  in  representing 

X,  ,  as  a  function  of  (77- 1) 

OSes  ' 

y 

Lateral  body  axis;  also  the  coordinate  of  a 
point  relative  to  the  origin  of  body  axes 

yB'  =¥- 

The  y  coordinate  of  CB 

,  yc 
yG’  =  — 

The  ^  ordinate  of  CG 

y® 

Vo 

A  c  -nate  of  the  displacement  of  CG  relative 

to  t.  rigin  of  a  set  of  fixed  axes 

Y 

Hydrodynamic  force  component  along  y  axis 
(lateral  force) 

Ya'  =  ^ 

Lateral  force  when  body  angles  (0,  )5)  and  control 
surface  angles  are  zero 

Y 

P 

V 

Y  '  = 

P  $p-t®  u 

First  order  coefficient  used  in  representing 

Y  as  a  function  of  p 

Y. 

P 

Y- 

V  1  _  P 

P  ~ 

Coefficient  used  in  representing  Y  as  a  function 
of  p 

^Plp! 

Y  ,  ■  =IiiM 

Pip'  ipf* 

Second  order  coefficient  used  in  representijig 

Y  as  a  function  of  p 
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^pq'  ' 

Coefficient  used  in  representing  Y  as  a  function 
of  the  product  pq 

Y  ' 

V 

Coefficient  used  in  representing  Y  as  a  function 
of  the  product  qr 

v=-24- 

^  pt^u 

First  order  coefficient  used  in  representing  Y 
as  a  function  of  r 

Y 

TTJ  U 

First  order  coefficient  used  in  representing 

Yy  as  a  function  of  (li-l) 

Y. 

r 

Yr 

Y.  <  s  __1 _ 

Coefficient  used  in  representing  Y  as  a  function 
of  f 

^IrUr 

„  •,  _  ^|r|6r 

|r  1  6t  “ 

Coefficient  used  in  representing  Y^^  as  a 
function  of  r 

Y 

V 

Y  .-  Yv 

V  “ip^iu 

First  order  coefficient  used  in  representing 

Y  as  a  function  of  v 

’^VT] 

Y  .-  ""vt, 

VT]  Jpt^U 

First  order  coefficient  used  in  representing 

Yy  as  a  function  of  (tj-1) 

Y. 

V 

Y^ 

=PF 

Coefficient  used  in  representing  Y  as  a 
function  of  v 

Y 

vq 

Coefficient  used  in  representing  Y  as  a  function 
of  the  product  vq 

^Irl 

Y 

vlr|  ■  ipi-* 

Coefficient  used  in  representing  Yy  as  a  function 
of  r 

%|vl 

Y  .  -  ^'^1''' 

^'Ivl  ■ 

Second  order  coefficient  used  in  representing 

Y  as  a  function  of  v 

^vl  V  ItJ 

„  .  _  '’^vIvItj 

First  order  coefficient  used  in  representing 
Yyjyj  as  a  function  of  {t)-X) 

Y 

vv' 

Y  '  - 

Coefficient  used  in  repre  enting  Y  as  a 
function  of  the  product  w 

Y 

wp 

Y  '  - 
y'P  ■  ipl^ 

Coefficient  used  in  representing  Y  as  a 
function  of  the  product  wp 

Y 

wr 

Y 

Y  <  - 

v.r  -  ipio 

Coefficient  used  in  representing  Y  as  a 
function  of  the  product  wr 

Y  .  - 

(>r  ■  Jpt^U^ 

First  order  coefficient  used  in  representing 

Y  as  a  function  of  6r 

Y  ■  =  -~.kryi 
^'•n  ip4^u'- 

First  order  coefficient  used  in  representing 

Y,  as  a  functio?!  of  (ri- 1) 
or 
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z 

•"f 

Nornuil  body  axis;  also  the  coordinate  of  a 
point  relative  to  the  origin  of  body  axes 

z 

X  •-  i 

B  1 

The  X  coordinate  of  CB 

*G 

*G  -  — 

The  X  coordinate  of  CG 

z 

o 

*0-4 

A  coordinate  of  the  displacement  of  CG 
relative  to  the  origin  of  a  set  of  fixed  axes 

Z 

Z'  =  ^ 

|p4*U* 

Hydrodynamic  force  component  along  z 
axis  (normal  force) 

z« 

Normal  force  when  body  angles  (ai  fi)  and 
control  surface  angles  arc  zero 

z 

pp 

Sp  "ipi* 

Second  order  coefficient  used  in  representing 
Z  as  a  function  of  p.  First  order  coefficient 
is  zero 

z 

Z  •  =  — *1- 
q  ip4^  u 

First  order  coefficient  used  in  representing 

Z  as  a  function  of  q 

Z  '  = 

qn  ip4=*u 

First  order  coefficient  used  in  representing 
Zq  as  a  function  of 

z. 

q 

^q 

Coefficient  used  in  representing  Z  as  a 
function  of  q 

^  |ql  6s 

Z  <  r  ^’q'^ 

lq|6s  ip-t'^u 

Coefficient  used  in  representing  Z^^  as  a 
function  of  q 

Z 

'P 

2  1  _  ^rp 

rp  "ipi* 

Coefficient  used  in  representing  Z  as  a 
function  of  the  product  rp 

Z 

rr 

z  '  - 

rr 

Second  order  coefficient  used  in  representing 
Z  as  a  function  of  r.  First  order  coefficient 
is  zero 

Z 

w 

7  1  _ 

W  ipl^U 

First  order  coefficient  used  in  representing 

Z  as  a  function  of  w 

Z 

W77 

z  '  = 

^  ip4^U 

First  order  coefficient  used  in  representing 
Z^  as  a  function  of  (17-  1) 

Z  . 

W 

7  .  _ 

‘w  Jp4^ 

Coefficient  used  in  representing  Z  as  a 
function  of  vv 

Z|  . 

|W| 

7  1  _  ^K'l 

|wl  ip4^U 

First  order  coefficient  used  in  representing 

Z  as  a  function  of  wj  equal  to  zero  for  sym¬ 
metrical  function 

^w|q| 

z  ,  ,•  =^lsl 
'"kl  ip4® 

Coefficient  used  in  representing  Z  as  a 
function  of  q  ^ 
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^wlw| 

^-wlwl 

1 

Z  ,  1 

w|  W  1 

,  _  ^wlw 
V 

^'ww 

Z  *  ^ 
wv; 

^ww 

■  ip-c* 

2, 

7  »  - 

Zfib 

■^6b 

6b 

7 

7  *  «- 

Z6s 

^6s 

^6s 

v 

7  •  • 

^bsTj 

bST) 

6s7J 

Second  order  coefficient  used  in  representing 
Z  as  a  function  of  w 

First  order  coefficient  used  in  representing 

Z  t  I  as  a  function  of  (n-l) 
w|w|  '  '  ' 

Second  order  coefficient  xiicd  in  representing 
Z  as  a  function  of  v.-;  equal  to  aero  for  sym¬ 
metrical  function 


First  order  coefficient  used  in  representing  Z 
as  a  function  of  6b 

First  ori.er  coefficient  used  in  representing 
Z  as  a  function  of  5^ 

First  order  coefficient  used  in  representing 

Z.  as  a  function  of  (77- 1) 

0  s 


a 


Angle  of  attack 


a 


Angle  of  drift 


V 

6 


Dsfiiection  of  bowplane  or  sailplane 
Deflection  of  rudder 
Deflection  of-  sternplanc 

Ur 

The  ratio 
Angle  of  pitch 


t 


Angle  of  ya-w 


♦ 


Angle  of  roll 


2 


b., 

1 


c. 

a 


SetB  of  constants  used  in  the  representation  of 
propeller  thrust  in  the  axial  equation 
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APPENDIX  B 

EXPRESSIONS  FOR  THE  LONGITUDINAL  TRANSFER  FUNCTION  COEFFICIENTS 

The  longitudinal  characteristic  equation  Is 

-  As'^  +  Bs'^  +  Cs’^  +  Ds'  +  E 

Long 

where 

A  =  (m'  -  X'*)(m'  -  Z'-)(I’  -  M’*)  -  X’‘M’*Z'*  -  Z'*M'«X'* 

'■  u  w  y  q  w  u  q  u  w  q 

-  -  Z'^x'^cr  -  M'.)  -  -  X'^)Z*.  . 

B  -  -  (m-  -  X'^)(m'  -  Z';)M'  -  z;(m'  -  X*-)(r  -  M'^) 

-  x;(m'  -  Z'^Xr  -  M'.)  -  X*^M'-(Z’  +  m-)  -  M^X-^Z'*  -  M’-X^Z*. 

-  w^i  -  2’u“;Z’q  -  Z;M-.X‘.  -  (m*  -  Z-^)M*.X;  -  M;(m-  -  Z-.)X*. 

+  M'.z;x'.  +  Z’.X'.M*  -  z;x-.(r  -  M'.)  -  z*.x;(r  -  m*.) 

-  -  X-.)(Z'  +  m*)  -  -  X*.)Z’.  +  M'-X^Z'-  . 

C  -  -  (m*  -  X’^)(m*  -  Z’^)M'  +  z;(m’  -  X'^)M'  +  x;(m'  -  Z’^)M' 

+  Z’X'CI'  -  M'O  -  X'-M'-Z*  -  M;X’*(Z:  +  m')  -  M'-X'(Z’  +  m') 
wu  y  q  wu9  uwq  uwq 

- 

-  m;(.’  -  z'i)x'  +  +  z;m;x-.  +  Z’;X';MJ  +  z;x’;m'  +  z';x;m' 

-  x;z;(i:  -  M'-)  -  -  X'-)ZJ  -  M;(m’  -  X';)(Z'  +  m') 


+  M''X'(Z'  +  •')  +  X'M'2';  -  • 

wu  q  uwq  uwq 


The  pitch  response  transfer  function  is 


e/6 


s  A. 


Long 


A. 

Long 


where 


A„  -  Ml  (m'  -  X'*)(n»'  -  Z'*)  +  Zl  +  X!  Z’*M'*  -  Ml  X’‘Z'* 

0  6  u  w  6wu  6uw  6wu 

e  e  e  e 

+  XI  (m'  -  Z'OM'*  +  Zl  M’‘(m'  -  X'*)  . 

6  w  u  6  w  u 

e  e 

Bfl  -  -  Ml  (m’  -  X'*)Z'  -  Ml  X'(m'  -  Z’*)  +  Zl  X'*M'  +  Zl  X'M’* 

9  6  u  w  6u  w  6wu  6wu 

e  e  e  e 

+  Xl  Z'*M’  +  X'  Z'M'*  -  MI  X'*Z'  -  Ml  X’Z’*  +  Xl  (m'  -  Z'*)M' 

5uw  6uw  6wu  6wu  6  wu 

e  e  e  e  e 

-  Xl  Z'M'*  -  Zl  M’*X'  +  Zl  M’(m'  -  X’*)  . 

6wu  6wu  6w  u 

e  e  e 

Co  -  Ml  X’Z'  +  Zl  X'M'  +  Xl  Z'M’  -  Ml  X'Z'  -  Xl  Z’M'  -  Zl  M’X’  . 

9  6uw  6vu  6uw  6wu  6wu  6wu 
e  e  e  e  e  e 

The  vertical  velocity  transfer  function  is 


83 


s  w 


A  s'^  +  B  s'^  +  C  s'  +  D 


w  w 


6  A. 
s  Long 


where 


K  *  Z'  (m'  -  X';)(I'  -  M'*)  +  X'  +  M*  Z'*X'*  -  Z!  M'-X'* 

wO  uy  <1  OUQOUQOUQ 

®  e  e’e 

+  XI  -  M'-)  +  Ml  (m’  -  X'*)Z’*  . 

•Sg  u  y  q  6^'  q 


=  -  Z'  (m'  -  X';,)m;  -  z;  X.'.d;  -  M';)  +  X'  M'Z';  +  x;  M'-(z:  +  m') 


uq  6uy  q  ouq  ou  q 
e  e  e 


+  MI  Z';X'  +  MI  Z'X’*  -  Z'  M'-X'  -  Zl  M'X'-  -  Xl  Z'*M' 
o  uq  ouq  6  uq  5uq  5  uq 
e^  e  e  e^  e^ 

^  <•'  -  +  »■>  -  »i  ■ 

e  ’  e  ’  e  ^ 


*  -  z^  (m'  -  x'*)M^  +  z;  x'm;  +  x;  m'*z2  +  x;  m'.(z:;  +  m')  +  m;  z'*x, 


'  ti  *  •  A.  ft**  T  ftv*  ftft  vft* 

u0  <Suq  (S  u6  ou  q 
e  ’  e  e 


0  u  6 
e 


+  M'  Z'Z'  -  Z'  M'*XI  -  ZI  M’X'  -  XI  Z'*M'  -  XI  Z'M'  +  Ml  (n’  -  X’^Z! 

°_uq  o_u0  ouq  0  u0  ouq  0  u  S 

e  e  e^e  e  e 

-  Ml  X'(Z'  +  m'). 

ouq 
e  ^ 

-  Zl  X'M'  +  XI  M'Z'  +  M'  Z'X'  -  Zl  M'X'  -  Xl  Z'M'  -  Ml  X'Z'  . 

W  OUO  ouo  OU0  OU0  OUu  OU0 

e  e  e  e  e  e 

The  forward  speed  transfer  function  is 

n'*  3  2 

,  6  A  s'-’  +  B  s'  +  C  s'  +  D 

u  s  u _ u _ u _ u 

6  *  A  *  A 

s  Long  Long 

where 

A  -  XI  (m'  -  Z'*)(I'  -  M'*)  +  MI  X'*Z'*  +  Zl  M'*X'*  +  Ml  (m'  -  Z'*)X'‘ 
u  0^  w  y  q  6^  w  q  6^  w  q  6^  w  q 


+  Zl  X'*(I'  -  M'O  -  XI  M'*Z'*  . 
0  w  V  q  0  w  a 
e  e  ^ 
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EXPRESSIONS  FOR  THE  LATERAL  TRANSFER  FUNCTION  COEFFICIENTS 


The  lateral  characteristic  equation  Is 

A,  -  s'(As'^  +  Bs’^  +  Cs'^  +  Ds*  +  E) 

Lat 

where 

A  =  (m'  -  Y'-)(I'  -  N'*)(I’  -  K'‘)  +  N**(-  I’  -  K’OY'* 

V  2  r  X  p  V  xz  r  P 

+  Y**K'*(-  I'  -  N'*)  -  N'*Y'*(I'  -  K'*)  -  K'*(I’  -  N'*)Y'* 
r  xz  p  V  r'  X  p  v'  z  r  p 


-  (m’  -  Y'*)(-  I'  -  N’*)(-  1’  -  K'*)  • 

'  V  xz  p  xz  r 


B  =  -  (m’  -  Y’-)(I'  -  N'*)K’  -  N’(m'  -  Y’*)(I'  -  K’*) 

'  v'  z  r  p  r  v' '  X  p 

-  -  N'p(i;  -  K'J)  +  »■;(-  r,  - 

♦  K<-  K,  - 

-  (m’  -  YpK';(-  -  »'■)  +  N'jY’jK’  +  -  It'.) 

-  -  >''?>  - 

+  (m’  -  Y'-)(-  I'  -  K'-)N'  +  (o'  -  Y’-)k:(-  I'  -  N';) 

V  xz  r  p  V  r  xz  p 


+  Y'(-  I'  -  K'')(-  I'  -  N’«)  . 
V  xz  r  xz  p 


86 


C  -  N'(m'  -  Y'*)K'  -  (m'  -  Y’»)(I*  -  N'OK!  +  Y’{I'  -  N’*)K’ 

r  V  P  V  z  r  t  V  z  r  p 

+  N'Y’d'  -  K**)  +  N**<-  I'  ~  K’')Y?  -  N**K'Y'  +  N'(-  I’  -  K'*)Y' 

r  V  X  p  V  xz  r  ♦  v  r  p  v  xz  r  p 

-  N'K'Y'*  -  Y’*K'*N!  -  Y'*K'N'  +  (m’  -  Y’)K'*N' 

vrp  rv^  rvp  rvp 

-  (m’  -  Y’)K'(-  I'  -  N'*)  +  N'*Y'*K!  -  -  Y')K'  +  N'Y’*K' 

T  V  XZ  p  V  r  V  r  p  vrp 

N’(id’  -  Y’)(I’  -  K'*)  -  K'*(I’  -  N’‘)Y!  +  K'*N’Y'  -  (!'  -  N'*)K'Y' 

V  r  X  p  V  z  T  (p  vrp  z  rvp 

+  K^H^Y'*  +  (m'  -  Y’^)(-  -  K'*)N‘  -  (m*  -  Y’-)rN^ 

-  Y'(-  I’  -  K’-)N'  -K’Y’(-1’  -N'O  . 

V  xz  r  p  r  V  xz  p 

D  -  N’(m'  -  Y’*)k:  +  Y'(l'  -  N'*)K!  -  N'Y’K'  ~  N’*K'Y! 

r  V  (p  V  z  r  p  rvp  vr(t> 

N'(-  I'  -  K’*)Y:  -  N’K'Y’  -  Y’*K’N’  +  (m*  -  Y’)K’*N!' 

V  xz  r<j>  vrp  r  v  p  r  v  P 

+  (m'  -  Y')K’N'  -  N’*(m’  -  Y’)K!  +  N'Y'*Kl  -  N’(m'  -  Y')K'  +  K'*N'Y! 

r'  V  p  v'  r'  41  V  r  (|i  v  r'  p  vrp 

-  (I'  -  N'*)K’Y:  +  K'N'Y'  -  (m’  -  Y’*)K'Nl'  -  Y'(-  I'  -  K’*)N! 

z  vrp  v'r'fr  v  xz  riji. 


+  K'Y’N'  . 
rvp 


E  -  -  N'Y'K’ 
r  V  (f 


n’k'y!  +  (o'  -  y’)k'n!  -  N'(o’  '  y')K;  +  k'n'y'  +  k'y'n' 

vri^  r  v^  V  T  ^  vri>  rvi^ 


The  sideslip  transfer  function  is 


6  \ 


^Lat  ^Lat 
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where 

*6  ■  '‘i  -  "'iX';  -  <-  'iz  -  -  '‘j  ■'■i'-  ^iz  -  »';> 

r  r  r 

+  NI  Y'-d'  -  K’*)  +  K1  (I*  -  Il’i)Y'*  -  y;  (-  I*  -  K'*)(-  I’  -  N'*) 
r  X  p'  6^'  z  r'  p  6^'  xz  r  '  xz  p' 


Ba  -  -  YI  (!'  -  N'*)K'  -  Y1  N’(I’  -  K’*)  -  N*  (-  I’  -  K'*)Y'  +  Nl  K'Y'< 
p  o  z  r  p  6  r  X  p  6  xz  r  p  6  r  i 

r  r  r  r  * 

+  Kl  Y'*N'  +  Kl  (m'  -  Y*)(-  I’  -  N'*)  -  N*  Y’*K' 
iSj.  r  p  6^'-  xz  p  r  p 

-  (m'  -  Y')N1  (!'  -  K’*)  +  K!  (I*  -  N'«)Y*  -  Kl  N’Y'* 

r  o  x  D  6  z  r  p  orp 
r  r  r 

+  Yl  (-  1'  -  K'*)N'  +  Y1  K*{-  I*  -  N'*)  . 

5  xz  r  p  6  r  xz  p 
r  r 

C-  -  -  Yl  (I'  -  N'*)K!  +  Yl  N'K'  -  NI  (-  I’  -  K'*)Y1  +  N'  K'Y’ 

6  5'z  r  i  6rp  6  xz  r  ^  orp 

r  r  r  r 

+  Kl  Y'*N1  -  Kl  (m'  -  Y’)N'  -  Nl  Y'.K!  +  (m’  -  YdNl  K' 

6^  r  <()  6^'  r'  p  6^  r  ((•  r  0^  p 

■f  Kj  (i;  -  h'j)t;  -  n;k;  t'  +  yj  (-  -  yj  «;»•  . 

r  r  r  r 

-  Yl  N'Kl  +  Nl  K'Yl  -  Kl  (m’  -  Y')N!  +  (o’  -  Y’)N’  Kl  -  N’K’  Yl 

6  r  r  6^  r  ^  •  r  0^  ^  r  6^  ♦ 

-  Yl  K’N’  , 

Sj.  r  4) 


The  roll  transfer  function  is 

n! 


1_ 


■  \at 


8’(A.s’^  +  B.s’  +  C  ) 
*  9 _ S_ 


at 


where 
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(m'  -  Y'^Xr  -  N’j.)  -  Y*  N'-(-  -  K'j.)  +  N’  K'^Y’j. 

-  N'^Y'-  +  Y'  -  N'p  -  N*  (in'  -  Y'^)(-  I'  -  K’p  . 

r  “r  r 

B .  -  -  K:  (m'  -  Y'*)N’  -  K!  Y'(I'  -  N'O  +  Y'  N'*K'  -  .Y)  N’(-  I'  -  K'*) 

0^  v'  r  6^  v'  2  r'  6^  v  r  6^  v'  xz  x' 

-  N'  K'-Cm'  -  Y')  +  Nl  K'Y'*  +  k!  N’*(m’  -  Y')  -  K'  N'Y’*  -  Yl  K'*N' 

ov  r  ovr  6v  r  6vr  6vr 

r  r  r  r  r 

+  Yl  K'(I’  -  N'*)  +  Nl  (m*  -  Y'*)K’  +  N*  Y’(-  I’  -  K’*)  . 

6  V  2  r  6  V  r  o  .v  xz  r 

r  r  r 

C.  •  Kl  Y'N*  +  Yl  N'K'  -  Nl  K’(m'  -  Y')  +  Kl  N’(in’  -  Y')  -  Yl  K’N' 

i  ovr  ovr  ov  T  ov  r  ovr 

r  r  r  r  r 

-  N'  Y’K'  . 

6  V  r 
r 

The  yaw  transfer  function  is 

N*^  3  2 

,  6_  A.s'^  B.s'  C.s’  +  D, 

i_  *  .  jfe _ i _ 4 _ Hl. 

R  Lat  Lat 

where 

A,  -  Nl  (m’  -  y'*)(I'  -  K'*)  +  Kl  N’‘Y'*  -  Yl  K'*(--  I’  “  N'O 

ib  0  v  x  o  ovn  ov  xz  o 

r  r  r 

+  Yl  N'*(I'  -  K'O  -  Nl  K’*Y'*  -  K’  (m'  -  Y’-)('  1'  -  N'*)  . 

0  V  X  p  0  V  p  0  V  xz  p 

B,  -  -  N 1  (o'  -  Y'*)K'  -  Nl  Y'(I'  -  K'*)  +  K'  N’*Y'  +  Kl  N’Y'* 

\b  tf  v  p  6v  x  p  ovp  ovp 

r  j.  Ky  rj-rj-r 

+  Yl  K'*N’  -  Yl  K'(-  I*  -  N'*)  -  Yl  N'*K’  +  Yl  N'(I’  -  K'*) 
ovp  Ov  xz  p  Ovp  Ovx  p 
r*^r  “^r  r 


-  Nl  K'«Y'  -  Nl  K'Y'*  +  Kl  (m’  -  Y’*)N'  +  Kl  Y'(-  I’  -  N'*) 

Ovp  ovp  0  v  p  ov  xz  p 
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:  -  -  N'  (m*  -  Y’OK!  +  Nl  +  K  N'.'Y!  +  K!  N'Y'  +  Yl  K'*N! 

V  V  ♦  Oy  V  p  6^  V  ^  V  p  Sy  V  ♦ 

+  Y'  -  Y'  N'^KJ  -  Y*  -  N*  K'^YJ  -  H*  K^YJ  +  K'  («•  -  Y'«)Nj 

-  Kl  Y'N'  . 

6^  V  p 


Y^K!  +  K*  N^Y'  +  Y*  K^N*  -  Y*  N^K'  -  M'  K’Y' 
r  r  *  ^  "r  *  ^  ♦ 


-  Mi  K'Y*  -  Ki  Y'N' 
S  V  •  *^6  V  ♦ 
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APPENDIX  C 
VERTLIN.FORT 


REAL  A,B,C,D,E 

INTEGER  NDEG.IER 

READ(4,*)  MT,XUD,ZMD,RIY,XL,U 

READ(4,*)  RMUD,Z2D,XMD,RM2D,RI1MD 

READ(4,*)  XeD,ZUD,Rno,2M,XU,Ze 

READC4,*)  R«U,XU,X2/ZU,HI1THET 

READ(4,*)  ZTHETA,XTHETA,RriM,XDE,ZDE,RMDE 

C23456 

C 

REAL  A1(5) , A2(3) ,A3(4) , A4(4) 

COMPLEX  Z1 ( 4) , Z2 ( 2 ) , Z3( 3) ,Z4( 3) 

C 

MRITE(6, 15) 

15  FORMAK IX , ’ IN  WHAT  FORMAT  DO  YOU  WANT  THE  ANSWER?’,/, 

1  '  DIMENSIONAL  WRITE  1',/, 

2  '  NONDIMENSIONAL  WRITE  O’) 

READ(7,20)  J 

IF  ( J)  2,2,1 
1  URITE(5,4) 

WRITE( 6 , 4 ) 

4  FORMATC IX, ’OUTPUT  VALUES  ARE  IN  DIMENSIONAL  FORM’) 

GO  TO  3 

C 

C 

2  WRITE(5,5) 

WRITE(6,5) 

5  FORMATC  IX,  'OUTPUT  VALUES  ARE  IN  NONDIMENSIONAL  FORM’) 

3  CONTINUE 

20  FORMATCII) 

C 

C 

c 

XLU=XL/U 

XLU2=XLU*XLU 

XLU3=XLU2*XLU 

XLU4=XLU3*XLU 

XLU5=XLU4*XLU 

C 

C 


C 

A  = 

1 

C234567 
C23456789 
3  = 

1 

2 

3 

4 

5 
C 

C 

c= 

1 


(WT-XUD)*(WT-ZWD)*(RIY-RM2D)-XWD*RMUD*Z2D-ZUD*RMWD*X2D 

-(WT-ZWD)*RMUD*X2D-ZUD*XWD*(RIY-RM2D)-RMWD*(WT-XUD)*Z2D 

1234567892123456789312345678941234567895123456789612345 
-CMT-XUD) *  C WT-ZWD ) * RM2-ZW* ( WT-XUD ) * ( RIY-RM2D ) 
-XU*(:’T-ZWD)*(RIY-RM2D)-XWD*RMUD*(Z2+UT)-RMU*XWD*Z2D 
-RMUD*XW*Z2D-ZUD*RMWD*X2-ZUD*RMW*Z2D-ZU-''RMWD*X2D-{  WT-ZWD)* 
RMUD*X2-HMU*  (WT-ZWD  )  *X2D  +  P.MUD*ZW*X2D  +  ZUD*XWD*RM2 
-ZU*XWD*(RIY-RM2D)-ZUD*XW*(RIY-RM2D)-RMWD*(WT-XUD)*CZ2+WT) 
-RMW* (UT-XUD)*Z2D+RMWD*XU*Z2D 


-(WT-XUD)*( WT-ZWD )*RMTHET+ZW*(WT-XUD)*RM2+XU*( WT-ZWD)* 
RM2+ZW*XU*(RIY-RM2D)-XWD*RMUD*ZTHETA-RMU*XWD*(Z2+WT)- 


II 
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VERTLIN.FORT  (cont.) 

2  RMUD*XW*  (  Ze+WT  )  -ZUD*RI1WD*XTHETA-ZUD*RMM*Xe-ZU*RMWD*Xe-ZU*RI1W* 

3  XQD-(MT-ZMD  )*RMUD*XTHETA-RMU*(  WT-ZMD)*X2+RriUD*ZM*X2  + 

4  ZW*RriU*X2D  +  ZUD*XMD*RMTHET  +  ZU*XWD*Rt12  +  ZUD*XM*RI12- 

5  XW*ZU*{RIY-Rn2D)-R«UD*(UT-XUD ) *ZTHETA-RMM* ( MT-XUD ) * 

6  (Z2+MT  )+RriWD*XU*(Z2+MT)+XU*R«M*Z2D-RMU*XM*Z2D 
C 

C234567 

D=  ZM*RMTHET*(MT-XUD)+XU*(MT-ZMD)*RMTHET-ZM*XU*RM2-RMU* 

1  XMD*ZTHETA-RMUD*XU*ZTHETA-Rt1U*XM*(Z2+WT  )-ZUD*RMW*XTHETA 

2  -ZU*RMWD'*XTHETA-ZU*RnM‘«X2-R«U*  (MT-ZMD)*XTHETA  +  Rf1UD*ZU* 

3  XTHETA  +  ZM*RnU*X2+ZU*XUD*MTHETA  +  ZUD*XM*RI1THET  +  XU*ZU*RM2 

4  -RMW*(UT-XUD  )  *ZTHETA  +  RKMD*XU*ZTHETA  +  RriW*Xa*  (  Z2  +  MT  ) 
02345678911234567892123456789312345678941234567895123456789612345 
C 

E=  -ZW*XU*RMTHET-RMU*XM*ZTHETA-ZU*RtlM*XTHETA  +  ZM*RriU*XTHETA 
1  +XW*ZU*RMTHET+XU*RnU*ZTHETA 

C 
0 

IF(J)  22,22,21 

21  A  =  A»iXLU4 
B  =  B  ''XLU3 
C=C*XLU2 
D  =  D*XLU 

C 

c 

0 

22  URITE(5,50) 

URITEC  6 , 50  ) 

50  FOR«AT(  IX,  ’COEFFS.  OF  CHARACTERISTIC  E2UATI0N’,/) 

WRITE C 5, 5  1  ) 

WRITE (6,51) 

51  FORMAT (7X,  ’  A  ’  ,  1 4X , ' B ’ , 1 4X , » C ' ,  1  4X ,  ’  D  ’  ,  1  4X  ,  '  E  ’  ) 

WRITE(5,  100)A,B,C,D,E 

WRITE(6,  100)A,B,C,D,E 
100  FORMAK  IX,  5E  14 . 6  ,/ J 
NDEG  =  4 
A  1 (  1  )  =A 
A  1 ( 2  )  =B 
A1 ( 3)=C 
A  1  (  4  )  =D 
A1  (5)=E 
C 
C 

CAIL  ZPOLR( A  1 ,NDEG,Z1 ,IER) 

C23456789 

C 

C 

URITEC  5 , 200  ) 

WRITEC  6 , 200  ) 

200  FORMATC IX ,' ROOTS  OF  CHARACTERISTIC  E2UATI0N',/) 

WRITE( 5,205) 

WRITE(6,205) 

205  FORMATC 10X, 'REAL' , 1 IX, 'IMAGINARY’ ) 

C 

WR1TE(5,201)  Z1 
URITE(6,201)  Z1 

201  FORMATC  1 X , 2F1 6 . 6 ,// ) 

C 

C 

C  PITCH  RESPONSE  TRANSFER  FUNCTION  NUMERATOR  POLYNOMIAL 
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VERTLIN.FORT  (cont.) 
c 
c 
c 

ATHETA  =  RMDE*(MT-XUD)*(UT-ZWD)+ZDE*XMD*RMUD  +  XDE*ZUD*RI1MD 
1  -R«DE*XMD*ZUD+XDE* (MT-ZMD)*RttUD+ZDE*MMD*(MT-XUD) 

C 

C234567 

BTHETA  =  -RnDE*(UT-XUD)*ZM-RMDE*XU*(MT-ZMD)+ZDE*XWD*RI1U  + 

1  ZDE*XW*RnUD  +  XDE'''ZUD*R«W  +  XDE*ZU*Rt1D-R»DE*XUD*ZU 

2  -RMDE*XU*ZUD+XDE* (WT-ZUD ) *RMU-XDE*ZM*RnUD 

3  -ZDE*RMWD*XU+ZDE*RMM*(MT-XUD) 

C 

c 

CTHETA  =  RMDE*XU*ZM+ZDE*XU*RMU+XDE*ZU*RMM-RMDE*XW*ZU 
1  -XDE*ZM*Rt1U-ZDE*RMW*XU 
C2345678 
C 

IF(J)  32,32,31 

31  ATHETA  =ATHETA*XLU2 
BTHETA  =BTH£TA*XLU 

C 

c 

32  MRITE(5,52) 

MRITE(6,52) 

52  FORMATf IX, 'PITCH  POLYNOMIAL  COEFFICIENTS’/) 

MRITE( S , 53 ) 

MRITE(6,53) 

53  FOR«AT(7X, 'ATHETA ’ , 9X, 'BTHETA' , 9X, 'CTHETA ’ ) 

WRITECS, 100)  ATHETA . BTHETA , CTHETA 
WRITE(6,100)  ATHETA, BTHETA, CTHETA 

C 

NDEG=2 

A2( 1 )=ATHETA 
A2 ( 2 ) =BTHETA 
A2(3)=CTHETA 
C 
C 

CALL  ZPOLR(A2,NOE6,Z2,IER) 

C 

C 

MRITE(5,54) 

MRITEC  6 ,54) 

54  FORMATC  IX,  'ROOTS’ ) 

WRITE(5,205) 

MRITE(6 , 205) 

WRITE(5,201)  Z2 
WRITE(6,201)  Z2 

C 

C  VERTICAL  VELOCITY  TRANSFER  FUNCTION  NUMERATOR  POLYNOMIAL 
C 

AU  =  ZDE* (MT-XUD)*  C  RIY-RM2D ) +XDE*RMUD*Z2D  +  RMDE*ZUD*XeD-ZDE*RMUD 
1  ^XOD  +  XDE^ZUD^C  RIY-RM2D ) +MDE* ( MT-XUD ) *Z2D 

C234567 
C 

BM  =  -ZDE*(WT-XUD)*RM2-ZDE»XU*(RIY-RM2D)+XDE*RMU*Z2D+XDE*RMUD 

1  *(Z2  +  WT  )+MDE'*ZUD*X2  +  RMDE«ZU*X2D-ZDE*RMUD*X2-ZDE*RMU*'X2D 

2  -XDE*ZUD*RM2+XDE*ZU* ( RIY-RM2D ) +RMDE* ( MT-XUD ) * ( Z2+MT ) 

3  -RMDE«XU*Z2D 

C23456789  1  1234567892  123456 78931234 567894  1234567895  1234567896  12345 

CM  =  -ZDE* ( MT-XUD ) *RMTHET+ZDE*XU*RM2+XDE*RMUD*ZTHETA+XDE*RMU 


noo  no  non  on  no  no  on  non  on 
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VERTLIN.FORT  (cont.) 


1  *(Z2+MT)+RMDE*ZUD*XTHETA  +  RMDE*ZU*Z2-ZDE*RI1UD*XTHETA 

2  -ZDE*RMU*X2-XDE*ZUD*RriTHET-XDE*ZU*RM2  +  RriDE*(MT-XUD) 

3  *ZTHETA-RMDE*XU*(Z2+MT) 


DW  =  ZDE*XU*RrtTHET  +  XDE*Rt1U*ZTHETA  +  RMDE*ZU*XTHETA 
1  -ZDE*R«U*XTHETA-XDE*ZU*RI1THET-RMDE*XU*ZTHETA 


IF(vJ)  42,42,41 
41  AU=AM*XLU3 
BU=BU*XLU2 
CW=CM*XLU 


42  MRITECS,  1051 
WRITE(6,  1051 

105  FORMATC IX ,' VERTICAL  VELOCITY  COEFFICIENTS 1 
MRITE(5,  1061 

MRITEC  6 ,1061 

106  F0RriAT(7X,  '  AM’  ,  9X,  'BM*  ,  9X,  'CM'  ,  9X,  '  DM'  1 
MRITE(5,1001  AM, BM, CM, DM 
MRITE(6,1001  AM, BM, CM, DM 


NDEG  =  3 
A3( 1 1 =AM 
A3( 2 1 =BM 
A3( 3 1 =CM 
A3(41=DM 


CALL  ZPOLR( A3,NDEG,Z3,IER) 


MRITE(  5, 202  1 
MRITE( 6 ,2021 

202  F0RnAT(  IX,  'ROOTS’ 1 
MRITEC  5 ,2051 
MRITE(6, 2051 
MRITE(5,2011  Z3 
MRITE(6,2011  Z3 


23456789 

AU  =  XDE*(MT-ZMD1*(Riy-Rn2D1+RnDE*XMD*Z2D+ZDE*RnMD*X2D+RnDE* 
1  (MT-ZMD1*X2D+ZDE*XMD*(RIY-Rn2D1-XDE*RnMD*Z2D 


BU  =  -XDE*(MT-ZMD1*Rn2-XDE*(RIY-R«2D1*ZM  +  RriDE*XMD*(Z2  +  MT1 

1  +RMDE*XH*Z2D+ZDE*RnMD*XO+ZDE*R«M*X2D+RnDE* (MT-ZMD1 *X2 

2  -RMDE*ZM*X2D-ZDE*XMD*RM2+ZDE*XM* ( RIY-RMQD 1 -XDE^RMMD 

3  *(Z2+MT1-XDE*RnM*Z2D 


CU  =  -XDE* (MT-ZMD 1 *RMTHET+XDE*ZM*RM2+RnDE*XMD*ZTHETA+RnDE*XW* 

1  CZ2+MT  1+ZDE*RnMD*XTHETA+ZDE*RnM*X2  +  RnDE'*  (MT-ZMD  1*=XTHETA 

2  -RnDE*ZM*X2-ZDE*XMD*R«THET-ZDE*XM«Rri2-XDE*RnMD*ZTHETA 


oo  oooo  oo  no  ocjo  cjo 
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VERTLIN.FORT  (cont.) 


3  -XDE*RriM*(Ze+MT) 


DU  =  XDE*ZU*RHTHET  +  RnDE*XW*ZTHETA  +  2DE*Rf1M*XTHETA 
1  -  RriDE*ZW*XTHETA-ZDE*XW*RI1THET-XDE*RMM*ZTHETA 


IFCJ)  62,62.61 
61  AU  =  AU*XLU3 

BU  =  BU*XLU2 

CU  =  CU*XLU 


62  MRITE(5.60) 

WRITEC  6 , 60  ) 

60  FORnATC  IX,  'FORWARD  SPEED  POLYNOMIAL  COEFFICIENTS',/) 
WRITEC  5 ,70  ) 

WRITE (6, 70) 

7  0  F0Rt1ATC7X,  'AU',llX,'BU',11X,'CU’,nx,’DU’) 
WRITECS.lOO)  AU.BU.CU.DU 
WRITE(6,100)  AU,BU,CU,DU 


NDEG=3 
A4( 1 )=AU 
A4( 2 ) =BU 
A4(3)=CU 
A4( 4) =DU 


CALL  ZP0IR(A4,NDEG,Z4,IER) 


WRITEC  5 , 202  ) 
WRITEC6,202) 
WRITEC  5 , 205  ) 
WRITEC  6 , 205  ) 
WRITEC5,201)  Z4 
WRITEC6,20n  Z4 


STOP 

END 


non  on  oo  on 


95 


HORLIN.FORT 


SEAL  A,B.C,D,E 

INTEGER  NDEG.IER 

READ(4.*)MT.RIX,RIY,RIZ,XL,U 

READ ( 4 . * ) YV, YR, YPHI, YVD , YPD , YRD  ,  YDR  ,  YP 

READ(4,*)RKV,RKP,RKR.RKPHI,RKVD,RKPD.RKRD,RKDR 

READ ( 4 , * ) RNV , RHR , RNVD , RNRD , RNDR, RNPD , RMP . RNPHI 

REAL  A1 (5) . A3(3) ,A2(4) ,A4(4) 

COMPLEX  Z 1 ( 4 ) . Z3( 2 ) , Z2 ( 3) ,Z4( 3) 

WRITEC  6 .155 

15  FORMAK IX, ’IN  WHAT  FORMAT  DO  YOU  WANT  THE  ANSWER?*,/, 
1'  DIMENSIONAL  WRITE  1’,/, 

2’  NONDIMENSIONAL  WRITE  O’) 

READ(7.20)J 
IF( J)2,2,  1 

1  WRITE(5,4) 

WRITEC  6 . 4 ) 

4  FORMATC IX ,’ OUTPUT  VALUES  ARE  IN  DIMENSIONAL  FORM’) 

GO  TO  3 

2  WRITE (5, 5) 

WRITEC  6 ,5) 

5  FORMATC IX, ’OUTPUT  VALUES  ARE  IN  NONDIMENSIONAL  FORM’) 

3  CONTINUE 

20  FORMAT(II) 


XLU  =  XL/U 
XLU2  =  XLU*XLU 
XLU3  *  XLU2*XLU 
XLU4  =  XLU3*XLU 
XLU5  =  XLU4*XLU 


A=(WT-YVD)*(RIZ-RNRD)*CRIX-RKPD)  +  RNVD* ( -RKRD ) *YPD 

1  + YRD*RK VD *( -RNPD) -RNVD* YRD* (RIX-RKPD)-RKVD*(RIZ-RNRD)* YPD 

2  -(WT-YVD)*(-RNPD)*(-RKRD) 


B  =  -(WT-YVD)*(RIZ-RNRD)*RKP  -  RNR* ( WT-YVD ) * ( RIX-RKPD ) 

1  -YV* ( RIZ-RNRD )*(RIX-RKPD) +RNVD*( -RKRD ) * YP-RNVD*RKR*YPD 

2  +RNV*(-RKRD)*YPD  - YRD*RKVD*RNP  +YRD*RKV* ( -RNPD  ) 

3  -(WT-YR)*RKVD*(-RNPD)  +  RNVD*YRD*RKP  +  RNVD* ( WT-YR )*( RIX-RKPD ) 

4  -RNV*YRD*(RIX-RKPD)  -  RKVD* ( RIZ-RNRD ) *YP  +RKVD*RNR* YPD- ( RIZ-RNRD ) 

5  *RKV*YPD 

6  +(WT-YVD)*(-RKRD)*RNP  +  ( WT-YVD ) *RKR* ( -RNPD ) 

7  +  YV*( -RKRD)* (-RNPD) 


C  =  RNR*(WT-YVD)*RKP  -( WT-YVD )*( RIZ-RNRD )* RKPHI+YV* ( RIZ-RNRD ) *RKP 

1  + RNR* YV*( RIX-RKPD )+RNVD*( -RKRD )*YPHI-RNVD*RKR*YP  +RNV*(-RKRD) 

2  *YP  -RNV*RKR*YPD  - YRD*RKVD*RNPHI  -YRD*RKV*RNP  +( WT-YR ) *RKVD*RNP 

3  -  (WT-YR)*RKV*(-RNPD)  +  RNVD* YRD*RKPHI  -  RNVD* ( WT-YR ) *RKP+ 

4  RNV*YRD*RKP  +  RNV* ( WT-YR )*( RIX-RKPD )  -  RKVD* ( RIZ-RNRD ) *YPHI+ 

5  RKVD*RNR*YP  -  ( RIZ-RNRD ) *RKV*YP  +RKV*RNR*YPD  + ( UT-Y VD ) * ( -RKRD ) 

6  *RNPHI  -(WT-YVD)*RKR*RNP  -  YV* ( -RKRD ) *RNP  -  RKR* YV* ( -RNPD ) 
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HORLIN.FORT  (cont.) 


c 

c 


21 


c 

c 

22 

50 


5  1 


100 


200 


205 


20  1 
C 
C 
C 


C 

C 

c 


c 

c 

c 


D  =  RNR*(WT-YVD)*RKPHI  +  YV* ( RIZ-RNRD ) *RKPHI  -  RNR*YV*RKP 

1  -RMVD=«RKR*YPHI  +  RMV*  ( -RKRD )  *YPHI  -  RMV*RKR*YP  -  YRD*RKV*RNPHI 

2  +(MT-YR) *RKVD*RKPHI  +  ( MT-YR ) *RKV*RNP  -RNVD* ( MT-YR ) * RKPHI+ 

3  RMV*YRD*RKPHI  -RKV* ( MT-YR ) *RKP  +RKVD*RNR* YPHI 

4  -  (RIZ-RNRD)*RKV*YPHI  +  RKV*RNR*YP  -  ( MT-Y VD ) *RKR*RNPHI  - 

5  YV* ( -RKRD ) *RNPHI  +  RKR*YV*RNP 

E  =  -RNR*YV*RKPHI  -  RHV*RKR*YPHI  +  ( UT-YR ) *RKV*RKPHI 
1  -RKV^CUT-YRI^RKPHI  +  RKV*RNR*YPHI  +  RKR*YV*HPHI 
IFC J) 22 , 22 , 2 1 
A  =  A*XLU5 
B  =  B*XLU4 
C  =  C*XLU3 
D  =  D*XLU2 
E  =  E^XLU 


MRITE( 5 , 50 ) 

MRITEC  6 , 50  ) 

FORtlAK  IX,  ’COEFFS.  OF  CHARACTERISTIC  EQUATION',/) 
MRITEC  5 ,51) 

MRITEC  6 ,51) 

FORMAT C7X,  'A' ,  14X,  'B' ,  1 4X ,  ' C ' ,  1 4X ,  ' D '  ,  1 4X ,  ’ E  '  ) 
MRITEC6,100)  A,B,C,D,E 
MRITEC  5 ,100)  A,B,C,D,E 

FORMAT  C 1X,5E14.6,/) 

NDEG  =  4 
A  1 C  1)  =  A 
A  1  C  2  )  =  B 
A1 C3)  =  C 
A1C4)  =  D 
A1 C5)  =  E 

CALL  ZPOLRC A1 ,NDEG,Z1 ,IER) 

MRITEC5,200) 

MRITEC  6  ,  200  ) 

FORMATC IX, 'ROOTS  OF  CHARACTERISTIC  EQUATION',/) 
MRITEC5,205) 

MRITEC  6  ,  205  ) 

FORMATC 10X,  'REAL'  ,  1 IX,  'IMAGINARY' ) 

MRITEC  5 , 20 1 )Z  1 
MRITEC6, 20  1  )Z1 

FORMATC 1X,2F16.6,//) 


ABETA  =  YDR*CRIZ-RNRD)*CRIX-RKPD)  -  RNDR* C -RKRD ) * YPD 

1  -  RKDR*YRD* C -RNPD )  +  RNDR* YRD* C RIX-RKPD ) 

2  +  RKDR*CRIZ-RNRD)*YPD  -YDR* ( -RKRD ) * C -RNPD ) 


1 


BBETA  =  -YDR*CRIZ-RNRD)*RKP  -  YDR*RNR* C RIX-RKPD ) 
-RNDR*C-RKRD)*YP  +  RNDR*RKR*YPD  +  RKDR*YRD*RNP 
+  RKDR*CMT-YR)*C-RNPD)  -RNDR*YRD*RKP 

-  CMT-YR)*RKDR*CRIX-RKPD)  +  RKDR* C RIZ-RNRD ) * YP 

-  RKDR*RNR*YPD  +  YDR* C -RKRD ) *RHP  +  YDR*RKR* C -RNPD ) 
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HORLIN.FORT  (cont.) 


CBETR  =  -YDR*CRIZ-RNRD)*RKPHI  +  YDR*RNR*RKP 

1  -RNDR*(-RKRD)*YPHI  +RNDR*RKR*YP  +  RKDR* YRD*RNPHI 

2  -RKDR*(MT-YR)*RNP  -  RNDR*YRD*RKPHI  +  ( MT-YR ) *RHDR*RKP 

3  +RKDR*(RIZ-RKRD)*YPHI  -  RNR*RKDR*YP  +  YDR* ( -RKRD ) *RNPHI 

4  -YDR*RKR*RNP 
C23456789 

C 

C 

DBETA  =  YDR*RNR*RKPHI  +  RNDR*RKR* YPHI  -  RKDR* ( WT-YR ) *RNPHI 
1  +  (MT-YR) *RNDR*RKPHI  -RNR*RKDR* YPHI  -  YDR*RKR*RNPHI 
IF(J)32.32,31 

31  ABETA  =  ABETA*XLU4*U 
B3ETA  =  BBETA*XLU3*U 
CBETA  =  CBETA*XLU2*U 
DBETA  =  DBETA*XLU*U 

32  MRITE(5,52) 

MRITEC  6 . 52  1 

52  FORMATC 1X, ’SIDESLIP  POLYNOMIAL  COEFFS.’,/) 

MRITE(5,53) 

MRITE( 6 , 53 ) 

53  FORMAT (7X, ’ABETA’ ,9X, ’BBETA’ ,8X, ’CBETA’ ,8X, ’DBETA’ ) 
MRITE(5, lOOIABETA. BBETA , CBETA , DBETA 

WRITE ( 6 ,100) ABETA, BBETA, CBETA, DBETA 

NDEG  =  3 

A2(1)  =  ABETA 

A2(2)  =  BBETA 

A2(3)  =  CBETA 

A2(4)  =  DBETA 

CALL  ZPOLR(A2,NDEG,Z2,IER) 

URITE(5,54) 

WRITEC  6 , 54  ) 

54  FORMATC  IX ,’ ROOTS  ’  ) 

WRITE(5, 205) 

WRITE( 6 , 205 ) 

WRITEC  5 , 20 1 )Z2 
WRITE(6,20  1  )Z2 

C 

c 

c 

APHI  =  RKDR^(WT-YVD)*(RIZ-RNRD)  -  YDR*RNVD* ( -RKRD ) 

1  +  RNDR*RKVD*YRD  -  RKDR*RNVD* YRD  +  YDR*RKVD* ( RIZ-RNRD ) 

2  -RNDR*(WT-YVD)*(-RKRD) 

C 

C 

c 

BPHI  =  -RKDR*(WT-YVD)*RNR  -  RKDR* YV* ( RIZ-RNRD ) 

1  +  YDR*RNVD*RKR  -  YDR*RNV* ( -RKRD )  -  RNDR*RKVD* ( WT-YR ) 

2  +  RNDR*RKV*YRD  +  RKDR*RKVD* ( WT-YR )  -  RKDR*RNV*YRD 

3  -  YDR*RKVD*RNR  +  YDR*RKV* ( RIZ-RNRD )  +  RNDR* ( WT- Y VD ) *RKR 

4  +  RNDR*YV*(-RKRD) 

C 

C 

C 

CPHI=  RKDR*YV*RNR  +  YDR*RNV*RKR  -  RNDR*RK V* C WT-YR ) 

1  +  RXDR*RNV*(WT-YR)  -  YDR*RKV*RNR  -RNDR*YV*RKR 
IFC J)42,42,41 
41  APHI  =  APHI*XLU3 
BPHI  =  BPHI*XLU2 
CPHI  =CPHI*XLU 
C 
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HORLIN.FORT  Ccont.) 


c 

42 

105 


106 


C 

c 

c 


202 


C 

C 


C 

C 

C 


C 

C 

C 


C 

C 

C 


6  1 


62 

60 


70 


MRITE(5, 105) 

MRITEC6, 105) 

FORMATC IX, 'ROLL  POLYNOMIAL  COEFFS 
MRITE(5, 106) 

MRITEC6. 106) 

FORriAT(7X,  '  APHI'  ,  1  IX,  'BPHI* 
MRITE(5,  1  00  )  APHI , BPHI , CPHI 
WRITE ( 6 , 1 00 ) APHI , BPHI, CPHI 


/) 


,1  1X,  'CPHI'  ) 


NDEG  =  2 
A3(1)  =  APHI 
A3(2)  =  BPHI 
A 3 ( 3  )  —  CPHI 

CALL  ZPOLR(A3,NDEG,Z3,IER) 
MRITEC  5, 202  ) 

WRITE(  6 , 202  ) 

FORMATC IX,  'ROOTS’  ) 
MRITE(5, 205) 

WRITEC  6 , 205 ) 

URITE(5, 20 1 )Z3 
WRITECe , 20 1 )Z3 


APSI  =  RNDR*(MT-YVD)*(RIX-RKPI))  +  RKDR*RNVD*  YPD 

1  -  YDR*RKVD* ( -RNPD )  +  YDR*RNVD* ( RIX-RKPD ) 

2  -  RNDR*RKVD*YPD  -  RKDR* ( WT-YVD ) * ( -RNPD  ) 


BPSI  =  -RNDR*(MT-YVn)*RKP  -  RKDR* YV* C RIX-RKPO ) 

1  +  RKDR*RNVD*YP  +RKDR*RNV*YPD  +YDR*RKVD*RNP 

2  -YDR*RKV*(-RNPD)  -  YDR*RNVD*RKP  +yDR*RNV* ( RIX-RKPD ) 

3  -  RNDR*RKVD*YP  -  RNDR=«RKV*YPD  +  RKDR*  ( MT-YVD )  *RNP 

4  +  RKDR*YV*(-RNPD) 


CPSI  =  -RNDR*(MT-YVD)*RKPHI  +  RNDR*YV*RKP  +RKDR*RNVD* YPHI 

1  +  RKDR*RNV*YP  +YDR*RKVD*RNPHI  +YDR*RKV*RNP  -  YDR*RNVD*RKPHI 

2  -  YDR*RNV*RKP  -  HNDR*RKVD*YPHI  -  RNDR*RKV*YP 

3  +  RKDR*(WT-YVD)*RNPHI  -  RKDR*YV*RNP 


DPSI  =  RNDR*YV*RKPHI  +  RKDR*RNV*YPHI  +  YDR*RKV*RNPHI 
1  -  YDR*RNV*RKPHI  -  RNDR*RKV*YPHI  -  RKDR* YV*RNPHI 
IF(vJ)62,62,61 
APSI  =  APSI*XLU3 
BPSI  =  BPSI*XLU2 
CPSI  =  CPSI*XLU 
WRITEC  5 , 60 ) 

WRITEC  6 , 60 ) 


FORMATC IX, 'YAW  POLYNOMIAL  COEFFS.’,/) 
WRITEC5,70) 

WRITEC  6 ,70  ) 

FORMAT C7X,  'APSI' , 1  IX,  'BPSI' , IIX, 'CPSI' , 1 IX 
WRITEC 5 , 100 ) APSI, BPSI, CPSI, DPSI 


DPSI’  ) 
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HORLIN.PORT  (cont.) 


MRITE(6, 100)APSI,BPSI,CPSI,DPSI 

NDEG  =  3 

A4( n  =  APSI 

A4C2)  =  BPSI 

A4(3)  =  CPSI 

A4(4)  =  DPSI 

CALL  ZPOLRC A4,KDEG,Z4,IER) 
WRITER  5, 202  ) 

MRITE( 6 , 202  ) 

MRITE(5,205) 

MRITEC  6 , 205) 

MRITEC  5>  20 1 )Z4 
MRITE(  6 , 20  nZ4 
STOP 
END 


100 


APPENDIX  D 


AXIAL  FORCE 


m 


-  VT  +  wq  -  Xq  (q®  +  r^)  +  (pq  -  r)  +  Zq  (pr  +  q 


i-  jl*  Tx  •  q®  +  X,,'  r*  +  X^^'  rp 
?  L  aa  ^  rr  m  ^ 


2  -  L  qq  *  rr  rp 

+  -§-  X®  fx*  '  u  +  X  '  vr  +  X  '  wq  1 
2  L  u  vr  wq  ^  J 


] 


+  X  X^fx  '  u®  +  X  •  V*  + 
7  L  uu  w 


X  •  w* 


ww 


] 


i  A^a  4.  V  '  68®  +  X.  ' 


-  -  6r‘’  +  X^  . 

6r  6r  6s  6s 


‘6b  6b 


+  i  pt®  [a^  u®  +  bj  uu^  +  c.  u^®  J 


-  (W  -  B)  sin  0 


-t®  [  X. _ '  V*  +  X _ '  w*  +  X 


vvT? 


WWTJ 


.  ,  6  ®  u* 

6r6rTj  r 


+  X.  .  „  6  ®  u® 
os6s77  s 


](77-l) 
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LATERAL  FORCE 


rt»|^v  -  wp  +  ur  -  (r®  +  p*)  +  Zq  (qr  -  p)  +  (qp  +  r)  ]  = 

‘‘  [’fr'  '  ^  P  ^  PIP,'  PIP'  ^  V  ”  *  V 

*T  [  ll^v  '  ^v,'  '■‘i  +  ^«rp'  ""P  ^  ’'wr'  ”P  ] 

/[y,'  ur+Yp'up  +  Y  |,,s,'“l'l‘'+Y^^^yji^|(.»+w»)*l|r| 


T  i^*'  "■ 


+  Y  '  uv  +  Y  I  I ' 
V  vj  v| 


!(»='  +w»)M] 


4-1-  1*  Y  ‘ 
2  L  vw 


vw  +  Y.  ' 
6r 


u®  6rJ 


4  (W  -  B)  cos  e  sin  <|) 

■’"f  Y^,'at(^.l) 

p  .s  r 


*1  <■’  +  ''vIviT,'  P|  ^  1  +  Ypr.,'  L  J  W-l' 
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NORMAL  FORCE 

m^w  -  uq  +  vp  -  (p^  +  q*)  (fp  -  q)  +  y^j  C'q  +  p)  J 

+f  [^4'  ^  +  ^pp'  P’  *■  ^rr'  ♦  ^p’  'P  ] 

+-  [^w'  "  +  \t'  ''’■  *  ^vp’  'Tf] 

2 

+7  X*  [z'  «q  +  Z,q,5.'  +  2„,„'  2^  ](»*  *»»)*!  Iql] 

J  W  I 

+•1  [2*'  U*  +  Z^'  uw  +  wl(v®  +w*)*|] 

+-|-  i*  L^Jw}'  '*■  ^ww'  ■*' 

+*£>  i*  fz  •  V*  +  2..'  u*  6s  +  Z.  •  u*  -abl 
2  I-  vv  6s  6b  >' 


+  (W  -  B)  cos  6  cos  ^ 


+  w®)* 


+  Z 


6S17 


6  u‘ 
s 


'](’)■ 


1) 
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lOif 


PITCHING  MOMENT 


1  q  +  (I  -  I  )  rp  -  {p  +  qr)  I  +  (p*  -  r®)  I  +  (qp  -  r)  1 
y  'I  »  3j  2'  ^  ^  xy  zx  yz 

+  m  I^Zq  (u.  -  vr  +  wq)  -  x^  (w  -  uq  +  vp)  J  = 

‘‘  [“V  i  *  “pp'  “rr'  *  “rp'  'P  *  “,1,| ' 


M''w4M  'vr+M  'vp 

«■#  •»«  ••w  * 


w 


vr 


vp 


] 


+-|-  /[Mq'  uq  +  ujqlfis  +  +  w»)»  |q] 

[m*'  u®  +  M^'  uw  +  w  j(v®  +  w®)*|] 


+T 


+  -5.  uiw  j  +  M^^'  Iw  (v®  +  w®)®  1] 

+  -f  ■*■  *^6s'  ^6b’  “"*■ 


.-  (Xq  W  -  Xg  B)  cos  0  cos  <»  -  (zq  W  -  Zg  B)  sin  0 


+  £  4"  M  '  uq  (TI-1) 

2 

+  7^'*  [^wV  ^wlwjq’  ^68Ti’ 
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YAWING  MOMENT 

*■  +  (^y  -  Pq  -  (q  +  rp)  +  (q*  -  p*)  I^y  +  (rq  -  p) 

+  m  Xq  (v  -  wp  +  ur)  -  (u  -  vr  +  wq )  J  = 

i*  [n^'  p  +  N^'  p  +  Np^-  pq  +  qr  +  I  ^  I  T  I r  I  ] 

^  ■’■  ^wp'  ■*■  ] 

^*[^p'  “P  "^^r'  ■^^lrl6r'  “l*‘l**‘  ■^^|v|r'  +  w®)*|; 

+r^®[N*'u*  +Nv’“'^  +  N^lvl'''  l(v*  +w«)^|] 

+  (x^  W  -  x^  B)  cos  0  sin  ♦  +  (y^  W  -y^  B)  sin  0 


+  -£-'t*N  UP  (TJ-l) 

2  rri 


+  ^v\y\n'  +  ^6pTi’  *r 
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KINEMATIC  RELATIONS 

U*  =  u®  4  V®  +  w® 

=  -u  sin  6  4  V  cos  0  sin  04wcos0cos^ 

•  • 

^  =  p  4  ^  sin  6 

9  -  q  -  ^  cos  8  sin  0 

cos  ^ 

^  -  .r  4  8  sin 

cos  O’COS^ 


^H^^4**********************************************^*****’^***^^*>^* 

THIS  SUBROUTINE  CALCULATES  STATE  DEHIVATIVES  OF  THE  TRUTH 
MuDt,L  (b-UOF  NONLINEAR  MODEL)  FOR  THE  FOLLOWING  EOS. 
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